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INLEIDING 


Het boek Werken met robots heeft de bedoeling om de technicus en de geïn- 
teresseerde leek, stap voor stap in te leiden in het boeiende domein van de 
moderne robotica. 

Om deze reden wordt in het eerste hoofdstuk een algemene inleiding gegeven 
tot de moderne industriële robots. Hier worden de algemene begrippen in 
verband met deze nieuwe technologie besproken. 

In het volgende hoofdstuk wordt ingegaan op een eenvoudige robotsimulatie 
van een robotarm met twee vrijheidsgraden met behulp van de populaire 
Commodore-64 computer. Ook de Commodore C-128 is natuurlijk geschikt 
om de simulatie uit te voeren. De programmalistings worden uitvoerig ver- 
klaard en het BASIC-programma is zo eenvoudig mogelijk gehouden, waar- 
door iedereen die over een andere BAsIC-computer beschikt in staat moet zijn, 
met eventueel enige wijzigingen in de software, deze robotsimulatie op zijn 
hardware te laten lopen. 
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1. INTRODUCTIE 
1.1 Het Robottijdperk 


De robot is de volgende stap in de evolutie van de moderne technologie. De 
doorbraak van de robotica in tal van industriële toepassingsgebieden dreigt 
nog grotere sociale en technische implicaties teweeg te brengen dan de com- 
puter enkele jaren geleden. 

Niemand kan voorspellen wat de impact zal zijn van de robots op ons leven 
in de toekomst. Iedereen is er echter van overtuigd dat de robot na ongeveer 
twintig jaar uit de kinderschoenen is gegroeid en is verworden tot een in- 
dustriële kracht die groter en ingrijpender is dan elke industriële machine uit 
het verleden. 

Er zijn twee redenen voor de snelle doorbraak van de robotica gedurende het 
laatste decenium, namelijk de economische ontwikkeling en de stormachtige 
evolutie van de micro-elektronica. 


Economische ontwikkeling 


De toepassing van robots moet economisch verantwoord zijn. Dat wil zeg- 
gen, dat de financiële investering, die het inzetten van een robot met zich 
meebrengt, zich binnen enkele jaren terugbetaald moet hebben. 

In 1960 kostte een operationele industriële robot meer dan negen dollar per 
uur, terwijl op dat ogenblik een operator van vlees en bloed hetzelfde werk 
verrichtte voor slechts de helft van deze prijs. 

Wanneer men vijfentwintig jaar later de kostprijs van een robot met die van 
een menselijke operator vergelijkt, is de inzet van een robot aanmerkelijk 
goedkoper geworden. 

De totale loonkosten van een arbeider in de auto-industrie bijvoorbeeld is 
gestegen tot ongeveer 20 dollar per uur terwijl de kostprijs van een robot op 
uurbasis slechts een derde hiervan bedraagt. 

Hoewel een goed getrainde menselijke operator prestaties levert die door- 
gaans superieur zijn aan het werk dat een robot verricht, zijn de groei van de 
loonkosten, het gebrek aan bekwame menselijke operators en het feit dat een 
robot dag en nacht door kan werken doorslaggevende factoren voor het in- 
zetten van robots in de industrie. 


Microcomputer-evolutie 


De stormachtige ontwikkeling van de micro-elektronica Is een tweede factor, 
die de doorbraak van de robotica in de industrie heeft veroorzaakt. De mi- 
crocomputer en vooral de single chip computer (microcomputer op één enke- 
le chip) hebben de robotfabrikanten een goedkope en betrouwbare compo- 
nent in handen gespeelt, nodig voor een intelligente besturing van hun ma- 
chines. 


Wanneer voor eenvoudige opgaven één enkele microcomputer volstaat, be- 
schikken de meer geavanceerde robots over een hiërarchisch gestructureerde 
vorm van chip-intelligentie. Een micro (soms ook wel een mini-) 
-computer zorgt voor de algemene besturing te zamen met de interface mens- 
machine. Deze mastercomputer geeft zijn opdrachten, mêt de benodigde nu- 
merieke informatie, door aan een reeks ondergeschikte microcomputers. De- 
ze laatste brengen gelijktijdig en onafhankelijk van elkaar een bepaald pro- 
bleem tot een oplossing. 

De hoge intelligentie te zamen met de toegenomen operatiesnelheid hebben 
aanleiding gegeven tot zeer ver doorgevoerde ontwikkelingen in de software 
waardoor robotsystemen activiteiten verrichten, die door een leek eerder tot 
het domein van de science fiction zouden worden gerekend. 


1.2 Wat is een robot? 


Het woord robot is afkomstig van het Tsjechische woord robota, wat slaaf 
of soms ook arbeider betekent. Dit woord raakte algemeen in de Westerse 
wereld bekend naar aanleiding van een toneelstuk van de Tsjech Karel Ca- 
pek, dat in 1921 in Londen werd opgevoerd. Sinds dit toneelstuk doet het 
woord robot ons denken aan een soort van automatische en gemechaniseerde 
mens en bij wie het menselijk (beter en geleerder gezegd: antropomorfolo- 
gisch) voorkomen met een hoofd, romp en ledematen duidelijk herkenbaar 
blijft. De twee robots 3CPO en ARTOO DITOO uit de film Star wars zijn 
hier algemeen bekende voorbeelden van. 

Industriële robots zien er echter geheel anders uit. Hoewel het moeilijk is een 
definitie te geven is die van het Robot Institute of America nog de meest voor 
de hand liggende: 


Een robot is een herprogrammeerbare, multifunctionele manipulator, be- 
doeld om materialen, machine-onderdelen, gereedschappen of gespeciali- 
seerde toestellen door middel van variabele geprogrammeerde bewegingen te 
verplaatsen voor de uitvoering van een grote variëteit van industriële taken. 


Herprogrammeerbaar betekent dat de machine in staat moet zijn om op- 
nieuw geprogrammeerd te worden voor een nieuwe en verschillende taak. 
Multifunctioneel wil zeggen dat de robot de mogelijkheid bezit talrijke en 
verschillende functies, afhankelijk van het programma en van de gebruikte 
werktuigen, uit te voeren. 

Algemeen bestaat een industrieel robotsysteem uit twee fundamentele com- 
ponenten: de mechanische robotarm en de computer voor de besturing. 
De robotarm is een mechanische constructie die door elektrische, pneumati- 
sche of hydraulische motoren aangedreven wordt. 

De besturingscomputer bevat de gegevens en de algoritmen (berekenings- 
schema’s) die nodig zijn om de robot bepaalde bewegingen te laten uitvoeren 
of om hem bepaalde acties te laten ondernemen. 
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Hierbij is het de bedoeling het uiteinde van de robotarm, de hand of de grij- 
per genoemd, in een bepaalde positie te brengen. Door in te grijpen in het 
polsgewricht wordt de mogelijkheid geschapen, aan de hand van de gekozen 
positie nog een gewenste richting te geven. 


1.3 Robotgeometrie 


Voor wat het in een bepaalde positie brengen van de hand betreft, vertonen 
de industriële robots een belangrijke variëteit in geometrie. 


Cartesiaanse geometrie 


De robots die deze geometrie vertonen beschikken over gewrichten die de le- 
dematen in een rechthoekig assenstelsel in onderling loodrechte bewegingen 
verplaatsen. Fig. 1.1 toont het principe van de cartesiaanse geometrie. 
Onder de werkruimte van een robot verstaat men het volume in de ruimte, 
waarbinnen de hand zich kan bewegen. leder machine-onderdeel of gereed- 
schap kan binnen deze ruimte door de robothand worden bereikt. Een robot 
met cartesiaanse geometrie heeft een rechthoekige werkruimte (fig. 1.2). 





1.1 Robot met cartesiaanse geometrie | 
1.2 Theoretische werkruimte van robot met cartesiaanse geometrie 


Men noemt ieder gewricht of iedere beweegbare as op de robotarm een vrij- 


heidsgraad. | | 

De vrijheidsgraden bij de cartesiaanse geometrie vallen samen met de X-, Y- 

en Z-richting van het rechthoekig assenkruis. 

Opmerking: 

De oriëntatie van de robothand of van het gereedschap wordt bepaald door 
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drie rotaties rond drie onderling loodrechte assen van het zogenaamd pols- 
gewricht; hierop wordt in de volgende paragraaf dieper ingegaan. 
Beweging van de hand volgens één as vereist slechts de verandering van één 
bepaalde positievrijheidsgraad. Wil men bijvoorbeeld het polsgewricht verti- 
caal verplaatsen, dan moet alleen de motor die de Z-richting stuurt, worden 
aangedreven. 

Andere robotgeometrieën vereisen de verandering van twee of meer bewe- 
gingsassen om de beweging van de hand volgens één coördinaatrichting mo- 
gelijk te maken. 

Behalve deze eenvoudige positionering biedt de cartesiaanse geometrie nog 
het voordeel dat de werkruimte zonder veel moeilijkheden gemakkelijk in de 
X-richting is uit te breiden. Daar de beweging van de hand in de werkruimte 
rechtstreeks volgens de drie vrijheidsgraden verloopt, js de sturing van een 
robot met cartesiaanse geometrie eenvoudig. Fig. 1.3 toont de werkruimte 
van zo’n geometrie in de praktijk, waarbij de verticale en horizontale slag- 
lengte en het bereik getoond worden. 
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1.3 Werkruimte van een robot met cartesiaanse geometrie in de praktijk 
Cilindrìische geometrie 


Fig. 1.4 toont een robot met cilindrische geometrie. Bij dergelijke robots 
brengen drie gewrichten de hand volgens een cilindrisch coördinatenstelsel in 
positie: 6 (rotatie), Z (hoogte) en R (radius of voerstraal). 

Fig. 1.5 toont dit cilindrisch coördinatenstelsel. De werkruimte van een ro- 
bot met cilindrische geometrie komt overeen met een cilinder of met een ge- 
deelte van een cilinder wanneer de draaiing om de verticale as niet de volledi- 
ge 360° bedraagt. 

Indien men de positie van de hand in een rechthoekig X-, Y- en Z- 
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1.4 Robot met cilindrische geometrie 
1.5 Theoretische werkruimte van robot met cilindrische geometrie 


coördinaatassenstelsel wil weten, moet men beschikken over een aantal 
transformatieformules die de positie van de hand in cartesiaanse coördinaten 
(X, Y, Z) geven, als de positie in de cilindrische gewrichtscoördinaten (6, Z, 
R) bekend zijn. 


Men heeft: 
X = R.cos6 
Y = R.sin0 
ZE 


Fig. 1.6 toont de werkruimte van de cilindrische geometrie in de praktijk. 


orizontaal 


H 
— bereik 


Horizontale 







Horizontaal 





Verticale 


slag 
Verticaal 
bereik 





1.6 Werkruimte van een robot met cilindrische geometrie in de praktijk 
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1.7 Robot met bolgeometrie 
Bolgeometrie 


Fig. 1.7 toont een robot met bolgeometrie. Robots met bolcoördinaten bren- 
gen de hand in positie door middel van drie gewrichten die rechtstreeks over- 
eenkomen met de drie variabelen van een bolcoördinatenstelsel: 6 (rotatie), # 
(elevatiehoek) en R (voerstraal). De positie van de hand wordt in dit coördi- 
natenstelsel berekend uit de drie gewrichtsvariabelen: 0, g en R. 





1.8 Theoretische werkruimte van robot met bolgeometrie 
1.9 Relatie tussen cartesiaanse coördinaten en bolcoördinaten 
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Fig. 1.8 toont dat de theoretische werkruimte van de bolgeometrie overeen- 
komt met het gedeelte van een bol afhankelijk van het rotatiebereik rond de 
assen. 

Uit fig. 1.9 kan de relatie tussen de cartesiaanse en de bolcoördinaten als 
volgt worden berekend: 


X = R;cos6 
Y = R;.sin0 
Z = R.sing 


Hieruit volgt met R, = R cosg: 


X = R.cosg.cos6 
Y = R.cosg.sin® 
Z = R.sing 


Met deze drie formules kunnen dus de X-, Y- en Z-posities van de hand wor- 
den berekend als men de gewrichtscoördinaten 6, en R kent. Omgekeerd 
kunnen de gewrichtscoördinaten berekend worden om de hand in de gewenste 
X-, Y- en Z-positie te brengen. Uit fig. 1.9 volgt: 


sing = % 

RS à 
tg8 = 
Ee ER ES 


Hieruit volgt: 


_ …L 
g = AIC SIN p 
0 = arctg + 


R-VX? + y? + z? 


Uit deze formules kunnen de gewrichtscoördinaten worden berekend. Fig. 
1.10 toont de praktische werkruimte van een robot met bolgeometrie. 


Gelede geometrie 


Fig. 1.11 toont een robot met gelede geometrie. Deze robots benaderen met 
hun ledematen de menselijke beweging heel sterk. Men heeft hier de drie 
gewrichtsrotaties: 8, „0, en 03 die men hier om redenen die geen uitleg behoe- 
ven de romp-, de schouder- en de elleboogrotatie noemt (fig. 1.12). 
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1.11 Robot met gelede geometrie 
1.12 De gewrichtshoeken voor de romp, de schouder en de elleboog voor de gelede 


geometrie 


De relaties tussen de cartesiaanse coördinaten en de gewrichtscoördinaten 

worden nu veel ingewikkelder dan bij de voorgaande geometrie. Het volgen- 

de hoofdstuk zal dieper op deze relaties ingaan. 

De robot met gelede geometrie heeft volgende voordelen: 

a. hoewel een minimaal vloeroppervlak in beslag wordt genomen, heeft deze 
robot een zeer groot horizontaal bereik. | | 

b. de robotarm kan gemakkelijk over een frontaal geplaatst obstakel heen 
reiken. 
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Een nadeel is echter dat deze robot hogere eisen stelt aan de besturing en “an 
de programmering omdat de relatie tussen de cartesiaanse coördinatenruim 
te en de gewrichtsruimte niet meer zo eenvoudig is. Het gebruik van een mu 
crocomputer met aangepaste software is hier dan ook een vereiste. 

Fig. 1.13 laat de horizontale en verticale doorsnede van de werkruimte van 
een robot met gelede geometrie in de praktijk zien. 


Horizontale 


Horizontaal 
bereik 
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1.13 Werkruimte van robot met gelede geometrie in de praktijk 


1.4 Oriëntatie van de hand 


In de voorgaande paragraaf werd door middel van een bepaalde geometrie 
de plaats aangegeven waar de robothand binnen een begrensde werkruimte 
een gespecificeerde positie kan innemen. Dit gebeurt in de driedimensionale 
werkruimte met behulp van een stelsel van drie coördinaten. Om de positie 
van de robothand ondubbelzinnig vast te leggen zijn er bijgevolg nog drie 
vrijheidsgraden te specificeren. 

Het is nu nog nodig, op deze gespecificeerde positie, aan de robothand een 
bepaalde oriëntatie te geven. Om robotbewegingen te laten beantwoorden 
aan een breed scala van manipulatietaken moet de hand niet alleen ieder 
punt binnen de werkruimte kunnen bereiken; maar de hand moet ook ieder 
gespecificeerd punt onder iedere willekeurige hoek kunnen benaderen. Om 
bijvoorbeeld een bout vast te schroeven moet de robot niet alleen de bout op 
een bepaalde positie brengen, hij moet bovendien de bout in een goed be- 
paalde oriëntatie ter plaatse brengen (fig. 1.14). 
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1.15 De roll-beweging 





1.14 Invloed van de oriëntatie bij het ter plaat- 
se brengen van een bout 


Pitch 





1.16 De pitch-beweging 1.17 De yaw-beweging 


De drie positievariabelen (X, Y, Zof B, 02 ‚83), die de positie van de robot- 
hand bepalen, worden over het algemeen nog door drie andere variabelen 
aangevuld om de oriëntatie van de robothand te specificeren. Deze, drie bij- 
komende variabelen zijn rotaties die meestal aangegeven worden door de en- 
gelse benamingen: roll, pitch, en yaw. Deze termen zijn ontleend aan het ge- 
bied van de aeronautica. 

Het zijn drie rotaties die ook door het polsgewricht van de mens kunnen 
worden uitgevoerd. Om in te zien wat deze rotaties voorstellen, brengt men 
de hand met de vingers in het verlengde van de onderarm. Draai nu het pols- 
gewricht zodanig dat de handpalm van onder naar boven draait terwijl de 
vingers steeds volgens de onderarm gericht blijven. Deze draaibeweging 
wordt de roll genoemd (fig. 1.15). 

De roll is bijgevolg een rotatie van het handgewricht om de as van de onder- 
arm. 

Houd vervolgens de onderarm horizontaal met de handpalm naar beneden. 
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Beweeg nu de hand op en neer zonder het polsgewricht te draaien. Deze 
wuifbeweging heet de pitch (fig. 1.16). De pitch is dus een draaibeweging van 
het handgewricht om een horizontale as loodrecht op de onderarm. 

Houd ten slotte de vingers met de hand recht vooruit in het verlengde van de 
horizontaal gehouden onderarm maar met de handpalm naar links gericht. 
Beweeg nu de hand met het polsgewricht zo ver mogelijk naar rechts (onge- 
veer 45° voor een gemiddeld menselijk polsgewricht) en dan weer terug naar 
links. Deze beweging is de yaw (fig. 1.17). 

De yaw is de draaibeweging van de hand om een verticale as loodrecht op de 
onderarm. 

Uit het voorgaande volgt dus dat er minstens zes onafhankelijke bewegingen 
nodig zijn (dus zes vrijheidsgraden) om ieder punt in de werkruimte vanuit 
clke hoek te bereiken. De menselijke arm beschikt juist over die zes vrijheids- 
graden: twee in het schoudergewricht, een voor de elleboog en drie voor het 
polsgewricht. Vandaar dat de mens, zelfs zonder de romp te bewegen, in 
staat is om met zijn hand elk punt binnen zijn reikwijdte vanuit elke hoek te 
bereiken. (Afgezien natuurlijk van rotatiebeperkingen van zijn gewrichten!) 
Het spreekt vanzelf dat deze bewering alleen maar opgaat voor zover iedere 
beweging onbeperkt kan worden uitgevoerd. Daar voor normale mensen de 
pitch tot 180° en de yaw tot 90° beperkt is, zijn er natuurlijk bepaalde com- 
binaties van positie en oriëntatie voor de mens onmogelijk, hoewel hij over 
cen arm met zes vrijheidsgraden beschikt. Hetzelfde kan van robots worden 
gezegd. 

ig. 1.18 toont de combinatie van de drie rotaties voor de oriëntatie van de 
robothand voor de Cincinnati Milacron robot met gelede geometrie. 
Merken we nog op dat iedere vrijheidsgraad een actuator of motor vereist. 
Len robot met zes vrijheidsgraden beschikt dus normaal over zes motoren 
plus één. Deze laatste is bedoeld om de grijper of klauw van de hand te slui- 
ten en brengt dus geen bijkomende vrijheidsgraad met zich mee. 








ELBOW 


SHOULDER EXTENSION 


SWIVEL 





CINCINNATI MILACRON T? ROBOT SYSTEM 


L.I8 De Cincinnati-robot met zes vrijheidsgraden 
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1.5 Besturingstechnieken 


Afhankelijk van de positionering van de robothand vanuit het besturingsor- 
gaan, heeft men open-lus-systemen (non-servo) en gesloten-lus-systemen 
(servo). 


Open-lusbesturing 


Robots met open-lusbesturing beschikken over een besturingsorgaan dat de 
bewegingen van de robotgewrichten bestuurt, zonder op de hoogte te zijn 
van de actuele positie en snelheid van de beweging rond iedere draai-as of 
volgens iedere translatie-as. Op iedere as zit dan voor de twee uiterste van de 
slag een limiet of stop die als einderitschakelaars de maximale verplaatsing 
volgens deze as op een bepaalde waarde vastlegt. — 

Het gewricht zal dan zijn beweging stopzetten wanneer het één van deze twee 
vastgelegde extreme waarden van zijn slag bereikt. Het besturingsorgaan zal 
de motor van een as zolang aansturen dat het gewricht van de ene uiterste 
stand de andere uiterste stand bereikt (fig. 1.19). 
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1.19 Open-lusbesturing van een gewricht 


Het besturingsorgaan verifieert niet of de nieuwe positie wel bereikt wordt. 
De mechanische nauwkeurigheid van de robot te zamen met de niet al te gro- 
te snelheid zorgen er voor dat deze eindpositie binnen voldoende kleine tole- 
rantiegrenzen kan worden ingenomen. | 

De open-lusbesturing levert voor eenvoudige standaardoplossingen weinig 
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problemen op. 

Voordelen van de open-lusbesturing: 

a. werkt met weinig ingewikkelde en goedkope robotsystemen. 

b. vereist geen hooggeschoold personeel voor bediening en onderhoud om- 
dat slechts twee limieten per bewegingsas moeten worden geprogram- 
meerd. 

c. flexibiliteit in de beweging kan worden opgevoerd als er meer dan twee 
stoppunten per as worden aangebracht. 

d. nauwkeurigheid kan worden verhoogd door middel van de zogenaamde 
limit sensing, waarbij het besturingsorgaan de mogelijkheid bezit om na 
te gaan of de limiet bereikt wordt. 


Gesloten-lusbesturing 


Robots met gesloten-lusbesturing beschikken over een besturingsorgaan dat 
geschikt is om de positie en de snelheid van het gewricht op dat moment te 
bepalen. Hiertoe moet er op iedere gewrichtsas een sensor voor de positie, en 
eén voor de snelheid aanwezig zijn. 
Het besturingsorgaan verkrijgt de informatie over de actuele gewrichtshoek 
van een positiesensor, meestal een potentiometer, een encoder of een resol- 
ver. 
ledere positiesensor levert een elektrisch signaal dat een maat is voor de hoek 
die een bepaald gewricht gedraaid is. Het besturingsorgaan vergelijkt nu de- 
ze waarde met de volgende gewenste hoekverdraaiing. Deze laatste wordt be- 
rekend uit de gegevens die tijdens het programmeren in het geheugen van het 
besturingsorgaan werden opgeslagen. 
Deze vergelijking levert dan een afwijking van de gewrichtshoek, die ge- 
bruikt kan worden om dat gewricht bij te sturen zodanig dat de nieuwe ge- 
wrichtshoek met de gewenste waarde zal overeenstemmen. Op dezelfde wijze 
wordt de verandering per tijdseenheid van de gewrichtshoek door middel van 
een snelheidssensor gemeten. Deze sensor is meestal een tachometer die het 
aantal omwentelingen van de aandrijfmotor van het gewricht meet. 
Dit signaal wordt vervolgens met de gewenste hoekverandering per tijdseen- 
heid vergeleken waardoor een afwijking in de hoeksnelheid van het gewricht 
wordt verkregen. Deze afwijking te zamen met de hoekafwijking, verkregen 
uit de eerste vergelijking, worden in het besturingsorgaan verwerkt. Daar- 
door wordt op de motorsnelheid en draaizin zodanig ingegrepen dat het ge- 
wricht zijn volgende positie onder de gewenste snelheid zal bereiken. 
Fig. 1.20 toont het principeschema van de gesloten-lusbesturing van een ge- 
wricht. | 
Als de robot over vijf of zes vrijheidsgraden beschikt wordt de positie en de 
snelheid van iedere as afzonderlijk gemeten en achtereenvolgens naar het 
besturingsorgaan doorgezonden. Deze bemonstering van de gewrichtsposi- 
ties en snelheden samen met de correctieve ingrepen vindt talrijke keren per 
seconde plaats zodat het oogt als een soepele beweging van de robotarm van 
de ene positie naar de andere. 
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1.20 Gesloten-lusbesturing van een gewricht 


Robots met een gesloten-lussysteem worden gebruikt in toepassingen waar 

een nauwkeurige besturing van de baan een eerste vereiste is. Dit is onder an- 

dere het geval bij het lassen, het schilderen etcetera. 

Voordelen van de gesloten-lusbesturing: 

a. flexibele programmabesturing waardoor robots in een grote verscheiden- 
heid aan taken kunnen worden ingezet. 

b. nauwkeurig volgen van vooraf ingestelde banen. 

c. mogelijkheid bepaalde punten onder bepaalde snelheden te bereiken. 


1.6 Besturing van de baan 


Baanbesturing is een techniek die door het besturingsorgaan wordt uitge- 
voerd om de grijper (of het gereedschap) de verschillende punten van een be- 
paald traject te laten doorlopen. Men onderscheidt bij baanbesturing vier 
methodes: stop-to-stop, point-to-point, bestuurde-baan en continue-baan- 
besturing. 


Stop-to-stop-besturing 


Tijdens de stop-to-stop-besturing werkt het robotsysteem in openlus, wat be- 
tekent dat de positie en snelheid van de diverse robotassen niet aan het bestu- 
ringsorgaan bekend zijn. 
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Omdat de beweging nu niet met een feedback-systeem wordt bemonsterd zal 
de actuele positie van een robotas slechts bekend zijn zodra de gewenste li- 
miet wordt bereikt. Vandaar dat de enige informatie die in het geheugen 
moet worden opgeslagen een sequentiële lijst van AAN- en UIT-bevelen voor 
iedere aangestuurde motor zal zijn. 


Point-to-point-besturing 


Als het besturingsorgaan over de mogelijkheid beschikt de positie van een 
gewricht op een zeker moment te bepalen, kunnen de motoren zodanig wor- 
den gestuurd dat deze op ieder punt van de beschreven baan kunnen stop- 
pen. 

Een gesloten-lus-robotsysteem kan ieder van zijn assen op elk punt laten 
stoppen. Het programmeren van een point-to-point-besturing komt dan neer 
op het schrijven van een serie bevelen van de volgende aard: 


Ga naar punt 1, stop 
Ga naar punt 2, stop 
Open grijper 

Ga naar punt 1, stop 
Sluit grijper 

Etcetera 


Tussen twee opeenvolgende punten (bijvoorbeeld 1 en 2) is er geen besturing 
vereist voor wat het doorlopen van de baan betreft van de grijper of de snel- 
heid van de verschillende assen. Omdat de verschillende assen met verschil- 
lende snelheden kunnen bewegen, en verschillende (hoek)afstanden hebben 
te doorlopen, zal dus de ene as reeds zijn bestemming bereikt hebben en al 
gestopt zijn voor de andere assen stoppen. 

Point-to-point-besturing wordt vooral gebruikt in industriële omgevingen 
waarin de werkruimte van de robot tamelijk leeg is en waar dus onvoorziene 
of onvoorspelbare bewegingen van de grijper geen schade kunnen aanrich- 
ten. 

Point-to-point-besturing is niet geschikt als er coördinatie moet zijn met aan 
de buitenkant van de robot bewegende voorwerpen, zoals bij transportban- 
den. 

ten belangrijke programmeerhulp voor de point-to-point-besturing is de zo- 
genaamde teach pendant. Dit is een toestelletje, meestal in de hand gehou- 
den, dat voorzien is van twee drukknoppen per vrijheidsgraad. Hierdoor kan 
de programmeur iedere as naar believen in één van twee bewegingsrichtingen 
aanspreken. 

Bovendien beschikt de teach pendant over een programmeertoets die de ac- 
tuele positie van ieder gewricht in het geheugen opslaat. Gewoonlijk is er nog 
cen drukknop als noodstop voorzien en is er nog een toets die een stap-voor- 
stap-run door het programma mogelijk maakt. 

Op deze manier kunnen dan in het geheugen van het besturingsorgaan dui- 
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zenden programmastappen voor de point-to-point-besturing van complexe 
toepassingen worden opgeslagen. 

Het grote voordeel van de point-to-point-besturing is dat relatief uitgebreide 
en complexe programma’s eenvoudig, op betrouwbare manier kunnen wor- 
den samengesteld door personeel met een niet al te hoge scholingsgraad. 


Bestuurde-baan-methode 


De bestuurde-baan-methode is eigenlijk een point-to-point-besturing met de 
bijkomende mogelijkheid de grijper te sturen wanneer deze zich van het ene 
naar het andere punt verplaatst. Het systeem wordt nu op dezelfde manier 
geprogrammeerd als een point-to-point-robot, waarbij dus ieder punt van de 
baan in het geheugen wordt opgeslagen door middel van de teach pendant. 
Het verschil echter is dat, wanneer het programma loopt, er een perfecte 
rechte lijn tussen de opeenvolgende geprogrammeerde punten kan worden 
beschreven. Hiertoe worden de motoren zodanig aangedreven dat de as die 
de grootste verandering vereist sneller wordt aangestuurd dan de assen die 
een kleinere verandering vergen. 

Bovendien kan meestal de snelheid tussen de verschillende punten worden in- 
gesteld. 


Continue-baan-besturing 


In meer complexe werkomstandigheden kan er van een robot geëist worden 
dat deze op continue wijze met zijn omgeving samenwerkt. Voorbeelden 
hiervan zijn booglassen, spray painting en de uitvoering van bewerkingen in 
samenspel met de bewegingen van een transportbandensysteem. 

Voor dergelijke industriële omgevingen is het een absolute noodzaak dat de 
positie en de oriëntatie van de grijper voor het hele traject exact bestuurd 
wordt. | 

Er bestaat een grote variëteit van technische middelen om deze continue- 
baanbesturing uit te voeren. De ingewikkeldheid van de besturingsmethode 
hangt natuurlijk af van het feit of de baan op voorhand bekend is (zoals bij 
het booglassen) of dat de baan gedurende de uitvoering van de beweging kan 
veranderen (zoals bij een transportbandensysteem). 


1.7 Componenten van een robotsysteem 


Afhankelijk van het standpunt dat men inneemt kan een robotsysteem op 
verschillende manieren in basiscomponenten worden onderscheiden. 
Materieel kan men een robotsysteem onderverdelen in: 

— de robot 

— het besturingsorgaan 

— het voedingssysteem 

De robot is natuurlijk antropomorfologisch te onderscheiden in de romp, 
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schouder, elleboog, pols, hand (of grijper) en is soms nog voorzien van gc- 
reedschap. 

Het voedingssysteem levert het nodige vermogen tot het activeren van de ver- 
schillende gewrichten en voor de algemene voeding van het elektronisch ge- 
deelte. | 

Het besturingsorgaan wordt gevormd door een programmeerbare computer 
die de bewegingsintelligentie van de robot bevat. 


Vanuit het standpunt van informatie-overdracht beschouwt men het robot- 
systeem als een blokschema. Men heeft dan de informatie of het signaal dat 
aan de ingang van een component (systeemblok) wordt aangelegd, de sig- 
naalverwerking binnen deze component en het signaal dat door deze compo- 
nent aan de uitgang wordt afgeleverd. 

Belangrijk is hierbij op te merken dat twee verschillende materiële compo- 
nenten identieke systeemblokken op het gebied van de informatieverwerking 
kunnen voorstellen. Zo zullen bijvoorbeeld de motoren voor de schouder- en 
het ellebooggewricht op gelijksoortige manier ingangssignalen in gewrichts- 
bewegingen omzetten. 
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1.21 Blokschema van een robot op gebied van informatie-overdracht 


Uitgaande van informatie-overdracht kan dan een robotsysteem door het 
volgende blokschema (zie fig. 1.21) worden voorgesteld. In zo’n blokschema 
wordt afgezien van de fysische structuur en van de geometrie van de robot. 
Het blokschema wordt ook slechts voor één vrijheidsgraad getekend. Men 
onderscheidt nu de volgende belangrijke componenten: 
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ACTUATOR 

De actuator maakt dat het gewricht waarmee het verbonden is, beweegt. De 
meest voorkomende actuators bij industriële robots zijn elektrische motoren 
en hydraulische cilinders. Een robotsysteem bevat net zoveel actuators als 
het bewegingsvrijheidsgraden heeft voor de complete besturing van de posi- 
tie en de oriëntatie. Hieruit mag men echter niet concluderen dat het aantal 
motoren waarover een robotsysteem beschikt gelijk is aan het aantal vrij- 
heidsgraden. De motor die dient tot het openen en het sluiten van de grijper 
mag immers niet als vrijheidsgraad worden gerekend. 


SENSOR 

In een gesloten-lussysteem moet op ieder ogenblik de computer over infor- 
matie beschikken wat de positie betreft en ook soms wat de snelheid van de 
actuator betreft. Hierbij betekent de positie de verplaatsing van de actuator, 
vanuit een bepaald aangenomen nulpunt als referentie gekozen. 


SENSORINTERFACE 

De elektrische signalen afkomstig van de sensoren moeten nu elektrisch zo- 
danig worden omgevormd dat deze geschikt zijn om in het computergedeelte 
opgenomen te worden. Dit gebeurt in de sensorinterface meestal door middel 
van zogenaamde analoog naar digitaal omzetting. 


GEGEVENSVERWERKING 

De gegevensverwerking vindt in het computergedeelte van het robotsysteem 
plaats. Deze gegevensverwerking kan in de volgende fundamentele operaties 
worden opgedeeld: 

Positiebepaling 

Gegeven de actuele positie en (of) de snelheid van een actuator, bepaal het 
benodigde stuursignaal om de actuator in de wenste positie te brengen. Deze 
berekening moet natuurlijk voor iedere actuator afzonderlijk gebeuren. 
Bewegingstransformaties 

Gegeven de actuele positie en snelheid van de actuator (dus van de gewrich- 
ten), bepaal de bijbehorende positie en oriëntatie van de grijper. Omgekeerd 
gegeven een gewenste positie en oriëntatie van de grijper, bepaal de gewenste 
toestand voor iedere actuator. 

Dynamische correcties 

Gegeven de mechanische belasting van de robotarm (inertie, wrijving, 
zwaartekracht) pas de sturing van de actuators aan om te komen tot betere 
en nauwkeuriger prestaties. 

Vermogensbesturing 

Dit systeemblok realiseert de koppeling tussen de uitvoer van het computer- 
gedeelte en de actuator. Het bestaat gewoonlijk uit een regelbare vermogens- 
besturing. 
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2. ROBOTSIMULATIE 


In dit hoofdstuk ontwikkelen we computerprogramma’s in SIMON'’s BA- 
SIC voor de Commodore-64 die de bewegingen van een gelede robot met 
twee vrijheidsgraden simuleert. De besturing van de twee gewrichten van de 
robotarm gebeurt in een eerste deel door middel van een joy stick. In een 
tweede deel wordt de besturing volledig aan de computer zelf overgelaten. 


2.1 Gewrichtstransformaties 


Het simulatieprogramma heeft als voornaamste doel het tekenen van een ro- 
botarm (bovenarm en onderarm) met twee gewrichten (schoudergewricht en 
ellebooggewricht) in hoge resolutie op het computerscherm 

Door middel van de stand van de joy stick worden de hoekposities van de 
twee gewrichten gewijzigd. De computer zal hieruit de coördinaten van het 
uiteinde van de onderarm berekenen wanneer ook de lengten van boven- en 
onderarm gegeven zijn. 

Telkens wanneer door middel van de joy stick nieuwe hoeken voor het 
schouder- en ellebooggewricht worden ingevoerd, zal de computer de nieuwe 
stand berekenen, de oude positie van de robotarm uitvegen en de nieuwe 
stand op het scherm tekenen. 

De berekening van de X-Y-coördinaten van de robothand (hier het uiteinde 
van de onderarm), wanneer de gewrichtshoeken gegeven zijn, noemt men de 
gewrichtstransformaties. Deze transformaties kunnen uit eenvoudige betrek- 
kingen van de driehoeksmeetkunde worden berekend. 


® 
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Xi: schouder (0,0) 
2.1 Gesimuleerde robotarm 
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Fig. 2.1 toont het beeld van de gesimuleerde robotarm zoals deze op het 
scherm van de computermonitor moet worden getekend. 

De coördinaten van het ellebooggewricht zijn X;, Y1; die van de hand wor- 
den door X, Y voorgesteld. Indien we veronderstellen dat het schouderge- 
wricht zich in de oorsprong (0,0) van het coördinatenstelsel bevindt, dan lui- 
den de gewrichtstransformaties: 


X= Xi +X2 

Y= Yi an Yz 
Volgens de figuur zal X, hier een negatief getal voorstellen. Als men reke- 
ning houdt met de gewrichtshoeken A; en Az worden de transformatiefor- 
mules: 

X = RcosAj + RcosAz 

Y = RsinA, + RsinA, 


Hierin stelt R de constante lengte van boven- en onderarm voor. Noteer dat 
op de figuur de hoek A, groter is dan 180° waardoor de cosinus dus negatief 
wordt. Er is dan automatisch rekening gehouden met een negatieve waarde 
voor X,. 

Indien nu het schoudergewricht niet in de oorsprong van het coördinatenstel- 
sel is gelegen, wat het geval is voor de tekening van de robotarm op het com- 
puterscherm, krijgt men voor de elleboog en voor de hand de volgende coör- 
dinatentransformaties: 


XE = Xs + RcOsÀ, 
Ye = Ys + RsinAi 
en 
Xn = XE + RcosAz 
Yu = Ye + RsinAs 
In deze formules staan de indices E‚ S en H respectievelijk voor elleboog, 
schouder en hand. 
Voor het geval van de Commodore-64 staat de oorsprong van het coördina- 


tenstelse] echter in de linkerbovenhoek van het scherm (zie fig. 2.2). 
Daarom krijgen de coördinatentransformaties nu de volgende vorm: 


Xr = Xs — RCOSÀi 

Yr = Ys — RsinA, 

Xu = XE + RcosAz 

Yu = Ye — RsinA» 
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2.2 Robotarm in het coördinatenstelsel van de Commodore-64 


2.2 Joy stick-besturing 


Om de robotsimulatie met twee vrijheidsgraden te besturen, maken we ge- 
bruik van een joy stick, waarbij de noord-zuid-handeling op het schouder- 
gewricht ingrijpt. Een verplaatsing van de joy stick in de oost-west-richting 
heeft een overeenkomende beweging van het ellebooggewricht tot gevolg. De 
fire-toets van de joy stick beeldt de positie van de hand op het scherm af 
wanneer deze toets wordt ingedrukt. 

Een BASIC-programma (in SIMON’s BASIC) voor deze joy stick-besturing is op 
fig. 2.3 gegeven. 


10 REM *ROBOTARM MET JOYSTICK* 

20 REM 

30 REM *“INITIALISATIE* 

40 COLOUR 1,1 

50 HIRESO,1:MULTI 0,2,14:CIRCLE75,150,4,6,3 
60 HOEK=.02:PEN=1 

70 R=60:X5=75:YS=150 

80 GOSUB 300 

90 REM *AFVRAGEN JOYSTICK-POSITIE® 

100 PEN=1:ELBG=0:SCH=0 

110 JS=PEEK (56321) 

120 PEN=JS AND 16 | 

130 J5=15-(JS AND 15) :IF JS=0 GOTO 100 

140 ON JS GOSUB 210,220,200,230,240,250, 200, 
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260, 270, 280 
160 GOSUB 300 
170 GOTO 100 
200 RETURN 
210 SCH=1 : RETURN 
220 SCH=—1 : RETURN 
230 ELBG=-1:RETURN 
240 ELBG=-1 : SCH=1 : RETURN 
250 ELBG=-1 : SCH=—1 : RETURN 
260 ELBG=1 : RETURN 
270 ELBG=1: SCH=1 : RETURN 
280 ELBG=1 : SCH=—1 : RETURN 
300 REM *BEREKENING X-Y COORDINATEN* 
310 Al=A1+HOEK*ELBG 
320 A2=A2+HOEK*SCH 
330 IF A1<O THEN A1=0 
340 XE=XS-R*COS(AL) :YE=YS-R*SIN(A1) *1.8 
350 XH-XE+R*COS (A2) :YH=YE-R*SIN(A2) *1.8 
360 IF XH<O THEN XH=0 
370 IF YH<O THEN YH=0 
380 REM*(HER)TEKENEN VAN DE ARM* 
390 IF XE=XO AND YE=YO GOTO410 
400 LINE XS,YS,X0,YO,0 
410 LINE XS,YS,XE,YE,1 
420 LINE X0,YO,XL,YL,O 
430 LINE XE,YE,XH,YH,1 
440 IF PEN=0O THEN LINE XL,YL,XH,YH,3 
450 XO=XE:YO=YE: XL=XH: YL=YH 
_460 RETURN 


READY. 


__ 2.3 BAsic-programma van de joy-stick-besturing 


Het eerste gedeelte van dit programma vormt de eigenlijke initialisatie, de 
kleur van het scherm wordt gekozen te zamen met de hoge-schermresolutie 
en multi-kleurenmode. Er wordt een kleine cirkel getrokken ter plaatse van 
het schoudergewricht (Xs =75; Ys = 150). 

De toename van de hoek voor de schouder en de elleboog wordt vastgelegd 
op 0,02 radiaal. Een flag-variabele PEN wordt op 1 geïnitialiseerd; dit bete- 
kent dat de positie van de hand niet moet worden weergegeven (PEN = 1:pen 
up; PEN = 0:pen down). 

De lengte van de boven- en van de onderarm wordt op 60 schermeenheden 
ingesteld. Voor de coördinaten van het schoudergewricht worden Xs = 75 en 
Ys = 150 gekozen. 
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Na afloop van de initialisatie wordt vanaf regel 300 naar een subroutine 
gesprongen die de coördinaten van de elleboog en van de hand berekent en 
die de robotarm op het scherm tekent. Vanaf regel 110 wordt de waarde van 
de joy stick ingelezen. Deze joy stick wordt aan game port 1 verbonden. 

In regel 120 wordt de toestand van de fire-toets in de PEN flag opgenomen. 
Regel 130 bepaalt de stand van de joy stick en kent vervolgens aan de varia- 
bele JS een waarde toe van 0 tot en met 100. Van deze waarde wordt in regel 
140 gebruik gemaakt om naar de bijbehorende subroutine te springen. 
Deze subroutines bepalen dan of de hoekveranderingen van het schouder- en 
van het ellebooggewricht positief of negatief moet zijn door de variabelen 
SCH en ELBG nul, positief of negatief te maken. 

Type dit programma in (na eerst SIMON’s BASIC geladen te hebben!) en RUN 
het. U zult vaststellen dat de robotarm ongeveer beweegt in de richting 
waarin de joy stick wordt bewogen. Probeer nu eens op het scherm een be- 
paalde figuur te tekenen (rechte lijn, vierkant of een cirkel). Het wordt dan 
vlug duidelijk dat het uiterst moeilijk is iets zinnigs met een zekere nauwkeu- 
righeid op het scherm weer te geven. Het is noodzakelijk de gewrichtshoeken 
door de computer te laten berekenen omdat een menselijke operator toch 
niet snel genoeg is om met voldoende nauwkeurigheid de robotarm te bestu- 
ren. 


2.3 Computerbesturing 


Om de besturing van de robotsimulatie efficiënter te laten verlopen zullen we 
de computer inschakelen om de nodige gewrichtshoeken snel en nauwkeurig 
te berekenen. 

Daarom zal de computer eerst een X-Y-coördinaat van de hand binnen de 
werkruimte in de overeenkomende gewrichtshoeken omzetten. Vervolgens 
wordt bepaald hoeveel stappen er nodig zijn om ieder gewricht op zijn eind- 
bestemming te doen belanden. Ten slotte moet er een algoritme ingeschakeld 
worden waardoor ieder gewricht in zijn eigen tempo zijn stap-voor- 
stapbeweging uitvoert, zodanig dat alle gewrichten op hetzelfde tijdstip hun 
eindbestemming bereiken. 


2.3.1 Berekening van de gewrichtshoeken 

Fig. 2.4 toont de positie van de robotarm, waarbij de hand het punt met 
coördinaten X, Y bereikt heeft. Deze coördinaten worden bepaald met de 
schouderpositie S als oorsprong. We beperken onze berekeningen tot het 
eerste kwadrant. 

Indien de handcoördinaten X, Y te zamen met de lengte R van de boven- en 
onderarm bekend is, wordt gevraagd de bijbehorende gewrichtshoeken A 3 
en A4 te berekenen. Uit de figuur volgt: 


Aj = arctg sr 
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Driehoek SEH is gelijkbenig daarom is SM gelijk aan de helft van de basis 
SH: 


SM = Lj = IVx? + y? 


j 


S : schouder 

E : elleboog 

H - hand 

R : armlengte 


2.4 Berekening van de gewrichtshoeken 


Uit de rechthoekige driehoek SEM volgt: 
Rails 





Voor de hoek Az kan er nu gevonden worden: 
L 
Àz = arctg 


Hieruit vindt men voor de hoek A3: 


A3 = MT — (Ar + Àj) 


Nu kan men L3 en L4 berekenen: 
L3 = RsinA3 
L4 = RcosA3 


Dan krijgt men voor Ls en Le: 
Ls ad 4 ee L3 
Le = X + L4 


/ 


En ten slotte wordt de hoek A4 berekend uit: 


A4 = arctg rz 
6 


Door middel van deze opeenvolgende formules is het mogelijk de vereiste 
gewrichtshoeken te berekenen als men de positie van de hand H (X, Y) kent. 
Deze formules bepalen dus de gewrichtstransformaties. 
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2.3.2 Bepaling van het aantal stappen 

Nadat door bovenstaande formules de gewenste hoek voor ieder gewricht be- 
rekend is, moet nog worden bepaald hoeveel stappen ieder gewricht moet be- 
wegen. 

Wanneer we dus de actuele hoekpositie kennen van een bepaalde gewrichts- 
hoek en we kennen tevens de nieuwe waarde van die hoek dan moeten we het 
verschil weten tussen beide hoeken. Als we dan dit verschil delen door de 
‘tapgrootte, verkrijgen we het aantal uit te voeren stappen. 

Het eenvoudigst zou men zo achtereenvolgens alle gewrichten een aantal 
‘stappen kunnen laten doorlopen. Hierdoor zal de hand wel de eindbestem- 
ming bereiken maar pas nadat een uitgebreid traject in de werkruimte is be- 
\chreven. 

ten efficiëntere oplossing is: alle gewrichten gelij ktijdig naar de eindbestem- 
ming laten stappen. 

Als de elleboog over tien stappen moet bewegen en de schouder over twintig 
stappen, kan men de schouder over twee stappen laten bewegen terwijl de el- 
leboog er dan maar één uitvoert, enzovoort, tot de eindbestemming bereikt 
IS. 

Deze oplossing is dan eenvoudig wanneer het ene stapaantal een veelvoud is 
van het andere. 

Wanneer de stapaantallen echter onderling ondeelbaar zijn, kan men van een 
eenvoudig algoritme gebruikmaken om deze stappen gelijkmatig te verdelen. 
Het algoritme levert een stap-voor-stapmethode die bepaalt wanneer de ge- 
wrichtshoeken een stapgrootte moeten toenemen. Eerst wordt het gewricht 
bepaald dat het grootste aantal stappen zal moeten uitvoeren. Dit grootste 
aantal stappen wordt dan door twee gedeeld, dit aantal wordt als teller ge- 
bruikt voor ieder gewricht. 

Vervolgens wordt van ieder gewrichtsteller het aantal stappen afgetrokken 
dat het gewricht moet bewegen. Als het verkregen verschil positief is, gaat de 
aftelling verder. Als het verkregen verschil negatief of nul is wordt door het 
gewricht een stap uitgevoerd en het maximum aantal stappen gedeeld door 
twee wordt bij de teller opgeteld. 

Hoewel we bij onze simulatie slechts over twee gewrichten beschikken, il- 
lustreren we dit algoritme met vier gewrichten: G 1, G2, G3 en G4. Neem aan 
dat deze gewrichten respectievelijk 10, 8,5 en 3 stappen moeten uitvoeren. 
De volgende tabel geeft een overzicht van dit algoritme. Een kruisje geeft 
aan dat het gewricht stapt. ‘ 


5-10=-5 x 
5-10=-5 x 
5-10=-5 x 
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Men kan nu vaststellen dat ieder gewricht het vereiste aantal stappen uitvoert 
en dat dit aantal gelijkmatig over de hele cyclus verdeeld is. 


2.3.3 Het programma 

Fig. 2.5 toont de programmalisting in SIMON’s BAsIC. Het eerste gedeelte is de 
initialisatie. Hierbij is de variabele hoek de stapgrootte die aan het schouder- 
en het ellebooggewricht wordt toegevoegd. 


REM**ROBOTARM MET COMPUTERBESTURINGY** 
REM**16/1/86 

REM**INITIALISATIE*®* 

COLOUR 1,1 

HIRES O,1:MULTI 0,2,14 

HOEK =.03 

R=60:XS5=75:YS=150 
E=15*4/180:S=E:B1=E:B2=E 

REM ** OPHALEN TEKENCOORDINATEN ** 


READ PEN, X,Y 

DATA 1,20,20,0,40,20,0,60,20,0 
DATA 80,20,0,80,40,0,80,60,0,80,80 
DATA 0,60,80,0,40,80,0,20,80,0 
DATA 20,60,0,20,40,0,20,20,0,0,0 
IF PEN=O AND X=0 AND Y=0 THEN 130 
REM ** TRANSFORMATIE VAN X-Y COORDINATEN 
REM NAAR GEWRICHTSHOEKEN* * 
A1=ATN(Y/X) 

L1I=SOR(XT2+YT2) /2 
L2=SQR(ABS(RT2-L1T2)) 
A2=ATN(L2/L1) 

A3=rr-A1-A2 

L3=R*SIN(A3) 

L4a=R*CO5 (A3) 

La= {Ld 

L6=X+L4 

A4=ATN(L5/L6) 

REM ** BEPALEN AANTAL STAPPEN** 
S(1)=INT((A4-E) /HOEK) 
E=E+S (1) *HOEK 

S(2)=INT((A3-S5) /HOEK) 
S=S+S5 (2) *HOEK 


2040 
2050 
2060 
2070 
2080 
2090 
2100 
2110 
2120 
2130 
2140 
2150 
2160 


REM ** ALGORITME MOTORBESTURING** 
NM=2 
MS=ABS(S(1)) 


FOR I=2 TO NM 


IF ABS(S(2))>MS THEN MS=ABS(S(2)) 
NEXT I 
FOR I=1 TO NM:C(I)=MS/2:NEXT I 
REM ** BEPALEN WANNEER MOTOR STAPT** 
FOR I=1 TO MS 
FOR J=1 TO NM 
C(J) =C (IJ) -ABS(S(I)) 

IF C(J)<O THEN C(J)=C(J) +MS:ELSE:GOTO 430 
ON J GOSUB 1100',1200 
NEXT J,I 
GOTO 100 

REM ** STAPPENMOTOR 1 ** 
ARM=SGN(S(J)) 

ELBG=0 

GOSUB 2000 

RETURN 

REM ** STAPPENMOTOR 2 *« 
ELBG=SGN(S(J)) 

ARM = O0 

GOSUB 2000 

RETURN 

REM ** VIDEO SIMULATOR ROBOTARM ** 
B1=B1+HOEK*ELBG:IF B1<0 THEN B1=0 
B2=B2+HOEK* ARM 

IF B1<0 THEN B1=0 

REM ** BEREKENING X-Y COORDINATEN * 
XE=XS-R*COS(B1) :YE=YS-R*SIN(B1)*1.8 
XH=XE+R*COS (B2) :YH=YE-R*SIN(B2) *1.8 
IF YH<O THEN YH=0 

IF XH<O THEN XH=0 

REM ** HERTEKENEN EN PLOTTEN PUNTEN ** 
LINE X5,YS5,X0,YO,0 

LINE X5,YS,XE,YE,1 

LINE XO,YO,XL,YL,O 

LINE XE,YE,XH, YH, 1 

IF PEN 0 THEN LINE XL,YL,XH,YH,3 
XO=XE: YO=YE: XL=XH: YL=YH 

RETURN 





READY. 2.5 BAsic-programma voor de computerbesturing 
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Vervolgens worden de data in groepen van drie gelezen. De eerste waarde 
van zo’n drietal gegevens bepaalt of de hand op het scherm tekent of niet 
(PEN = 1 niet tekenen; PEN = 0 tekenen). 

De volgende twee getallen stellen de X- en de Y-coördinaat van het punt van 
de hand voor dat door de robotarm moet worden bereikt. Wanneer de hand 
een bepaalde figuur op het scherm moet tekenen, stellen deze getallen de 
coördinaten van de verschillende punten van die figuur voor. 

Fig. 2.6 toont een voorbeeld van een vierkant zoals dit op het scherm wordt 
getekend. 

Ook bestaat de mogelijkheid een programma toe te voegen dat zijn eigen 
coördinaten berekent. Dit is het geval voor de programmalisting van fig. 2.7 
waarbij de coördinaten van een cirkel worden berekend en door de robotarm 
op het scherm worden getekend. 
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2.6 Voorbeeld van het tekenen van een vierkant 


10 REM**ROBOTARM MET COMPUTERBESTURING** 
15 REM**MET FUNCTIEVOORSCHRIFT** 

20 REM**24/1/86 

30 REM**INITIALISATIEË®* 

AG COLOUR 1,1:PEN=1 

50 HIRES O,1:MULTI 0,2,14 

60 HOEK =.03 

70 R=60:X5=75:Y5=150 

80 E-15*m/180:S=E:B1=E:B2=E 


90 REM ** OPHALEN TEKENCOORDINATEN ** 


100 DEFFNA(X) =SQR(900-(X-50) * (X-50) ) +50 
110 FOR X=20 TO 80 STEP 10 

115 Y=FNA(X) :GOSUB 140 

120 NEXT 

125 FOR X=70 TO 20 STEP —10 
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Y=100-FNA(X) : GOSUB140 
NEXT 
GOTO 137 
REM ** TRANSFORMATIE VAN X-Y COORDINATEN 
REM NAAR GEWRICHTSHOEKEN** 
AL=ATN(Y/X) | 
LI=SOR(XT2+YT2) /2 
L2=SOR(ABS(RT2-L1IT2)) 
AZ=ATN(L2/L1) 
A3=tr-A1-A2 
L3=R*SIN(A3) 
La=R* COS (A3) 
L5=Y-L3 
L6=X+L4 
A4=ATN(L5/L6) 
REM ** BEPALEN AANTAL STAPPEN** 
S(1)=INT((A4-E) /HOEK) 
E=E+S (1) *HOEK 
5 (2) =INT((A3-S5) /HOEK) 
9=0+5 (2) *HOEK 
REM ** ALGORITME MOTORBESTURING** 
NM=2 
MS=ABS(5(1)) 
FOR I=2 TO NM 
IF ABS(S(2))2MS THEN MS=ABS(S(2)) 
NEXT I 
FOR I=1 TO NM:C(I)=MS/2:NEXT I 
REM ** BEPALEN WANNEER MOTOR STAPT** 
FOR I=1 TO MS 
FOR J=1 TO NM 
C(J) =C (TJ) -ABS(S(J)) 
IF C(J)<O THEN C(J)=C(J)+MS:ELSE:GOTO 430 
ON J GOSUB 1100,1200 
NEXT J,I 
RETURN 
REM ** STAPPENMOTOR 1 ** 
ARM=SGN(S(J)) 
ELBG=0 
GOSUB 2000 
RETURN 
REM ** STAPPENMOTOR 2 *%* 
ELBG=SGN(S(J) ) 
ARM = 0 
GOSUB.. 2000 
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2060 
2070 
2080 
2090 
2100 
2110 
2120 
2130 
2140 
2150 
2160 


RETURN 

REM ** VIDEO SIMULATOR ROBOTARM ** 
B1=B1+HOEK*ELBG:IF B1<0 THEN B1=0 
B2=B2+HOEK* ARM 

IF B1<O THEN B1=0 

REM ** BEREKENING X-Y COORDINATEN * 
XE=-XS-R*COS(B1) :YE=YS-R*SIN(B1)*1.8 
XH=XE+R* COS (B2) :YH=YE-R*SIN(B2) *1.8 
IF YH<O THEN YH=0 

IF XH<O THEN XH=0 

REM ** HERTEKENEN EN PLOTTEN PUNTEN ** 
LINE X5,YS,XO,YO,0 

LINE XS,YS5,XE, YE, 1 

LINE XO,YO,XL,YL,O 

LINE XE,YE,XH, YH, 1 

IF PEN = O THEN LINE XL,YL,XH,YH,3 
XO=XE: YO=YE: XL=XH: YL=YH: PEN=0 
RETURN 


READY. 


pf, 
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BASIC-programma voor het tekenen van een cirkel 





3. EERSTE KENNISMAKING MET 
DE ROBOT CS-113 


De CS-113 (fig. 3.1) is een microprocessor (Z-80a) gestuurde robot met vijf 
vrijheidsgraden. 





CS-113- ROBOT 


Eenheid: mm. 


3.1 De robot CS-113 met zijn belangrijkste afmetingen 


Om met de robot te kunnen werken moet u over het volgende beschikken: 


— de robot CS-113 + interface 
— de Commodore-64 + het beeldscherm 
— de diskdrive + schijf 
(de schijf bevat de volgende programma’s: 
—  CENTRONIX 7000 
—- SIMONS BASIC 
— de voeding voor de robot (12 volt gelijkspanning, 4 ampère) 


Buiten het educatief gebruik van deze robot op het gebied van de robotica en 
van de coördinatentransformatie kan hij ook effectief worden ingezet voor 
het uitvoeren van lichte taken in industriële automatisering, doch alleen daar 
waar geen hoge positioneringsnauwkeurigheid is vereist. Uiteraard is de ro- 
bot CS-113 ook geschikt om de handelingen van een industriële robot te si- 
muleren, voor demonstraties en voor onderzoek op de gebieden van roboti- 
ca. | 
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De robot CS-113 is een stappencoördinaten-robot. Hij wordt zo genoemd 
omdat zijn bewegingen overeenstemmen met die van een menselijke opera- 
tor. 

Hij heeft vijf assen en elke as imiteert een menselijke beweging. 

De eerste as correspondeert met de heup. Deze as kan in één richting bewe- 
gen. Deze kan bijvoorbeeld draaien maar niet buigen. De tweede as cor- 
respondeert met de schouder. Deze kan alleen verticaal en horizontaal bewe- 
gen. De derde as correspondeert met de elleboog. De combinatie van de vier- 
de en vijfde as correspondeert met de pols. Deze assen kunnen draaien en 
buigen. De zesde as correspondeert met de hand. 


De stappencoördinaten-robot heeft een relatief grote werkruimte. Hij is voor 
verschillende doeleinden te gebruiken. De meeste industriële robots zijn van 
dit type. Met de CS-113 als educatief en research instrument kunt u de wer- 
king van een industriële robot simuleren en zo de industriële robot beter le- 
ren begrijpen. 


3.1 Elektrische verbindingen 


Kijk goed na of uw robot op 110 V of 220 V AC is ingesteld. De netspanning 
is instelbaar op de bijgevoegde geschakelde voeding. Verbind de linkse 
poort, aan de achterkant van de robot, met de voeding (zie fig. 3.2). Verbind 
de middelste poort met de daarvoor bestemde platte kabel, met de user-poort 
van de Commodore-64. 


INTERFACE POSRT 
CS-M3 — CBM 6Y 
Con. 4 





CS-M3 ROBOT ACHTERARANZICHT 


CBM Gy ROBOT CS- 3 







OEREN TEEN KE: 


vignpasiumunIFS 31 





ONDER 


3.2 Aansluitingen van de robot CS-113 en van de user-poort van de Commodore-64 
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Controleer of de verbindingen zoals in tabel 3.1 verbonden zijn. 


EE > 
Km 
Smet ij 
hmnee 
nnn 
Kerk 
eredame . : 
jk 
ommen: : 
OK 
hmm: 
Km Ì} 


A 
B 
C 
D 
E 
F 
H 
J 

K 
L 
M 
N 
B 


ER 





GND 2, 4, 6, 8 
ACK 19 

3 

5 

7 

9 

11 

13 

15 

17 

20 BUSY 

10, 12, 14, 16 


STROBE 1 


Tabel 3.1: Connector CBM-64 - CS-113 


Als de CBM-64 vervangen wordt door een Apple-II wordt de verbinding ge- 
maakt volgens tabel 3.2 en wordt de interfacekaart in slot O geplaatst. 


SIGNAAL CON. PEN NR APPLE II 


2, 4, 6, 8 
10, 14, 16 


Tabel 3.2 





11 
13 
15 
17 


20 
19 
2, 4, 6, 8, 10 
12, 14, 16, 18 


De verbindingskabel tussen de CS-113 en de CBM-64 moet goed worden 
aangesloten. Deze kabel mag tijdens de werking van de robot niet worden 
ontkoppeld. Ook moet steeds de spanningsbron ingeschakeld blijven bij elke 
handeling van de CS-113 of communicatie met de CBM-64 (controleer de 


groene powerlamp). 
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Mocht tijdens de communicatie met de CBM-64 en de CS-113 de spannings- 
bron niet ingeschakeld zijn, dan zal de bouwsteen 74LS373 (A6) beschadigd 
worden. Deze bouwsteen vinden we terug op de printplaat van de robot. 


De groene LED op de voorkant geeft aan dat de robot voedingsspanning 
krijgt. 

Als de hand open is als de robot ingeschakeld wordt, dan zal deze automa- 
tisch sluiten. 


3.2 Controle van de werking 


Enkele aanwijzingen vooraf 


Beweeg de robot niet met de hand. Zorg ervoor dat als de robot in werking is 
hij vrijstaat en niet geblokkeerd wordt. Als de robot wordt geblokkeerd, 
kunnen fouten in het programma optreden en kan mechanische schade het 
gevolg zijn. 


Programmeer uw robot niet zodanig dat hij zijn eigen krachten te boven gaat 
(bijvoorbeeld een te groot aantal stappen). 


Vermijd opstelling in omgevingen waar veel trillingen voorkomen. Stof of 
vochtigheid moeten eveneens worden vermeden. 
Zorg dat de ventilatiegaten in de bodem van de CS-113 open blijven. 


Zorg ervoor dat de speling in de verbindingskettingen niet te groot wordt. 
Het zal de nauwkeurigheid van de robot bij positionering beïnvloeden. 


Zelftest procedure 


Deze zelftest kan worden uitgevoerd als de CS-113 nog niet geprogrammeerd 
is. Het doel van deze zelftest is om elk bewegend deel te besturen. Ook is dit 
een eenvoudige procedure om alle bewegende delen terug naar de nulpositie 
te brengen. 


Test 1 


Schakel de spanningsbron aan (controle powerlamp). Druk op de reset-knop 
(geel) en direct daarna op de testknop (rood). Houd beide knoppen inge- 
drukt. Laat nu de reset-knop los terwijl u nog drie seconden de testknop in- 
gedrukt houdt. Als de hand al gesloten is zal de CS-113 telkens als de test- 
knop ingedrukt wordt één handeling verrichten. De handeling duurt totdat 
de testknop losgelaten wordt. 
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Als de testknop voor de eerste keer wordt ingedrukt, komt stappenmotor 1 
in actie en draait de basis tegen de klok in. De motor stopt als de testknop 
losgelaten wordt. 

Als u voor de tweede keer op de testknop drukt, komt motor 1 opnieuw in 
actie en draait de basis met de klok mee. 

Als u voor de derde en vierde keer drukt, beweegt motor 2 de schouder van 
de CS-113 respectievelijk neer- en opwaarts. 

Als u voor de vijfde en zesde keer drukt, komt motor 3 in actie en beweegt de 
elleboog van de CS-113 neer- en opwaarts. 


Voor de zevende keer de knop indrukken: de hand van de robot draait tegen 
de klok in. En als u voor de achtste keer drukt, met de klok mee. De motoren 
4 en 5 werken gesynchroniseerd. 


Om de hand naar beneden en naar boven te laten bewegen, moet u nogmaals 
twee keer op de testknop drukken. 

Motor 6 opent en sluit de hand, na de instructie van de testknop. Als u nog 
cen keertje hierop drukt, zal de robot de eerste beweging herhalen. 


Test 2 


Test 2 wordt verricht met behulp van een in ROM opgeslagen programma, 
speciaal bedoeld om de gesynchroniseerde werking van de motoren, de volg- 
orde van de bewegingen en de hoeken die de robot maakt te testen. 


Stel de robot met behulp van test 1 op nulpositie in. De pijlen, op elk onder- 
deel aanwezig, moeten overeenkomen. Druk op de reset-knop om test 1 uit te 
schakelen. Druk nogmaals op beide knoppen. Laat de reset-knop los en 
houd de testknop vast totdat de CS-113 met de tweede test begint. De CS-113 
start met een gesynchroniseerde actie door de instructie van de ROM. 


De bewegingen zullen in drie verschillende snelheden verlopen gebaseerd 
vanuit de nulpositie (S1-S3-S5). 

Druk een seconde op de testknop en de CS-113 stopt op de nulpositie nadat 
zijn bewegingen op de hoogste snelheid (S5) zijn beëindigd. 

Druk nu op de reset-knop om het programma af te sluiten. 


3.3 Instructieset 


Deze paragraaf heeft als doel een basis te geven voor het schrijven van pro- 
gramma’s voor het besturen van de CS-113. 

Door middel van het combineren van de verschillende instructies tot een pro- 
gramma, zal de robot bepaalde bewegingen uitvoeren. | 
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Nulpositie of Home-positie 
Inputvorm : Z 
Voorbeeld : PRINT +#4,”Z’’ 


Als de robot in een bepaalde positie staat, al of niet de nulpositie, dan zal de- 
ze positie als referentiepositie (Home-positie) vast worden gehouden als de 
instructie Z is gegeven. 


Als het Z-commando niet uitgevoerd wordt dan zal de positie waarin de ro- 
bot stond toen de voeding werd ingeschakeld als referentiepositie worden 
aangenomen. Ds 


Move 
Inputvorm : M al,a2,a3,a4,a5,a6 
Voorbeeld: PRINT #4, ”’M 500,0,0,0,0,0° 


al,a2,a3,a4,a5,a6 is het aantal stappen van de desbetreffende stappenmotor. 
Het aantal stappen is echter beperkt (zie tabel 3.5). 


Tabel 3.3 en 3.4 geven de a-parameters van de MOVE-instructie te zamen met - 
het robotonderdeel dat bewogen wordt. 


In ons voorbeeld zal de basis van de robot 500 stappen tegen de wijzers van 
een klok in bewegen. De andere delen bewegen niet. 


al CW ACW | 





























basis 
a2 schouder opwaarts neerwaarts 
a3 elleboog opwaarts neerwaarts 
hand dicht open 


Tabel 3.3 


ì beweging pols 


draaiing — — —» ACW 

draaiing — — —» CW 
neerwaarts 

opwaarts 


Tabel 3.4 
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Openen van de hand 
Inputvorm: O 
Voorbeeld: PRINT #4,” 0” 


Dit commando zal de hand volledig openen. Het commando is ongeldig als 
het twee keer achter elkaar wordt gegeven. 


Sluiten van de hand 
Inputvorm: C 
Voorbeeld: PRINT #4,” C®’ 


Dit commando zal de hand volledig tot zijn uiterste limiet sluiten. 
De knijpkracht wordt begrensd met een einderitschakelaar. 


Bewegingssnelheid 
Inputvorm: Sa 
Voorbeeld: PRINT #4,”S5’’ 


Deze instructie dient om de snelheid van de motoren in te stellen. 
Parameter a is gekozen tussen één en vijf. 


SI, S2 kunnen gebruikt worden voor lage snelheid, onder maximale be- 
lasting (500 gr maximaal). 

S3, S4 en S5 kunnen gebruikt worden voor grotere snelheden onder minima- 
le belasting. 


De gekozen snelheid is geldig totdat er een andere snelheid gekozen wordt. 
Limiet 

Inputvorm: La 

Voorbeeld: PRINT #4,” L1°’ 


Deze instructie controleert het aantal stappen van de motor. Wanneer a = 1 
is de test gebaseerd op de referentiepositie voor de werkruimte. 

Als de inputstap het maximale bereik heeft (zie tabel 3.5), stopt de CS-113 en 
het foutmeldingslampje gaat branden (Roop). Op dit moment reageert de ro- 
bot alleen op het N-commando (zie instructie N). 

Wanneer a = Ois er geen controle. 
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Maximale verplaatsingstappen vanaf de nul-positie 


grad/stap 


basis 1000 CW [1000 ACW 


600 600 
opwaarts [neerwaarts 


600 600 
opwaarts | neerwaarts 


1800 1800 
— — CW — + OPW 
+ + ACW |+ — neerw 


1800 1800 
dicht open 
















schouder 





















elleboog 

















pols 










Tabel 3.5 


Opmerking: 

Als M4 en MS input (1800, — 1800) bedraagt dan zal de pols 90 graden neer- 
waarts bewegen (pitch). 

Wanneer M4 » MS of M4« MS dan zal de beweging van het buigen en draai- 
en tegelijk plaatsvinden (pitch en roll). 


Nest 
Inputvorm: N 
Voorbeeld: PRINT #4,”N” 


Bij deze instructie zal de robot terug naar de positie gaan die is vastgelegd 
met behulp van het nulpositiecommando (Z). 


Here 
Inputvorm: Ha 
Voorbeeld: PRINT #4,’ H10°’ 


Indien de robot in een bepaalde positie staat in de ruimte, dan zal met dit 
commando deze huidige positie opgeslagen worden in de standaard RAM. 
Deze RAM kan 100 posities opslaan. 

Als de RAM uitgebreid wordt met 2 Kbytes kan het aantal opgeslagen posities 
uitgebreid worden tot 270 posities. 
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Positie 

Inputvorm: Pa,‚al,a2,a3,a4,a5,a6 

Voorbeeld: PRINT #4,” P8, — 500,500, — 200,0,0,0°’ 

Ook al staat de robot in een bepaalde positie dan kan een andere positie, ten 
opzichte van de nulpositie, opgeslagen worden in de standaard RAM. 

De functie van de parameters al-a6 is dezelfde als bij het commando MOve. 
Ook wat betreft de beperkingen. 

Goto 

Inputvorm: Ga 


Voorbeeld: PRINT #4,” G1°’ 


Door dit commando wordt de CS-113 in de opgeslagen positie gebracht van 
Ha of Pa. 


Vertraging 

Inputvorm: Da 

Voorbeeld: PRINT #4,” D3’’ 

Deze instructie zal gebruikt worden om een tijdelijke stop te verkrijgen. 

De gekozen tijd (a seconden) heeft een nauwkeurigheid van ongeveer 1% van 
de a seconden. 

Wait 

Inputvorm: G 

Voorbeeld: PRINT #4,” D3”’ 

Door dit commando zal de robot geen enkele instructie ontvangen en uitvoe- 
ren voordat de schakelaar JI gesloten is. De aansluiting van schakelaar J1 


staat achteraan de robot. 


Figuur 3.3 toont hoe het sluiten van de schakelaar de ingangsspanning van 
de poort naar de aarde trekt. 


47 








+5 


CONTROL CKT 


DATABUS 
Ji 


3.3 Sluiten van schakelaar J, trekt de ingangsspanning naar de aarde 


3.4 Programmavoorbeeld 


Initialisatie van de user-poort 


Om de robotfuncties te kunnen uitvoeren aan de hand van eenvoudige in- 


structies dient eerst de SIMONS BASIC en de CENTRONICS PARALLEL INTERFACE in de 
CBM-64 geladen te worden. 


Deze machinetaalprogramma’s zitten op disk of cassette onder de naam SI- 
MONR en CENTRONIC 7000 opgeslagen. 


We gaan als volgt te werk: 

— laden van SIMONR 
LOAD "’SIMONR’,8,1 
KSYS 32778» 

— laden van CENTRONIC 7000 
LOAD "’CENTRONIC 7000’ ,8,1 
KSYS 29520» 

_— OPEN 4,4,7 : CMD 4 


De communicatie tussen CBM-64 en de robot zal nu verlopen via een centro- 


nics parallel interface (centronics print interface) die beschikbaar is aan de 
user-poort. 


Voorbeeld 


Voordat u het programma start, moet u ervoor zorgen dat de robot in nulpo- 
sitie staat. 


10 PRINT #4,” Z”’ De actuele positie van de robot 


wordt als nulpositie genoteerd. 
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20 PRINT #4,” S5”’ Als snelheid wordt de hoogste 
waarde gekozen. 


30 PRINT #4,”’M500,0,150,0,0,0’’ De basis doet 500 stappen vol- 
gens de wijzers van een klok, de 
elleboog 150 stappen opwaarts. 


40 PRINT #4,” O0’ | Open de hand. 

50 PRINT #4,” H1’’ Onthoud deze positie nummer 1. 
60 PRINT #4,” C”’ Sluit de hand. 

70 PRINT #4,N”’ Ga terug naar de nulpositie. 

80 PRINT +#4,”’D3’’ Wacht drie seconden. 


20 PRINT +#4,”’P3, — 500,0,150,0,0,0° Positie drie wordt gedefinieerd. 


100 PRINT #4,” G1”’ Ga naar positie één. 
110 PRINT #4,”G3’’ Ga naar positie drie. 
120 PRINT #4,”N”’ Ga terug naar nulpositie. 


3.5 Programmeren van de randappara- 
tuur van de CS-113 | 


Met behulp van bepaalde instructies kan men de CS-113 met andere randap- 
paratuur verbinden via een 4-bit of 8-bit parallelle output-poort en input- 
switch-poort (zie figuur 3.4). Met randapparatuur bedoelen we einderitcon- 
tacten, toestandschakelaars enzovoort. 

De 4-bit parallelle uitvoerpoort is inwendig bereikbaar. Deze poort staat op 
de printplaat links van de power-controlelamp. 

De 8-bit parallelle uitvoerpoort of expandpoort staat achteraan de robot. 
De input-schakelaarpoort bevindt zich op de printplaat, links van de fout- 
controlelamp. 


3.5.1 4-bit parallelle uitvoerpoort 
Inputvorm: Qa 


Voorbeeld: PRINT #4,” Q7”’ 
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3.4 
50 


E2 1/0-PORT INTERFACE CIRCUIT OUTLINE 


a. 4-BIT PARALLEL OUTPUT PORT 


(connector 4) 
CON.4 


(74 LS 75) 


b. 8-BIT PARRALLEL OUTPUT PORT 
(connector 3) 


‚ INPUT SWITCH PORT 
(connector 7. 8.9 0) 


IC-E8 (74LS 366) 





1/O-poort interface 





De outputdata van de parameter a, dat een decimaal getal is tussen O en 15, is 
van de 4-bit parallelle uitvoerpoort. Dus in het voorbeeld wordt het binair 
getal OIII (= 7) op de pennen naar buiten gebracht. 


Deze instructie kan gebruikt worden om in de loop van het programma be- 
paalde toestellen (bijvoorbeeld transportbanden) op te starten of te stoppen. 


De uitvoerpoort poortaansluiting is zoals in tabel 3.6 aangegeven. 


Uitgangssignaal 





Tabel 3.6 


Als de ” Qa’’-instructie niet gebruikt wordt, zal de uitgangspoort actief laag 
zijn. 

3.5.2 8-bit parallelle uitvoerpoort 

Inputvorm: Rb 

Voorbeeld: PRINT #4,” R31FF’’ 

De inhoud van de geheugenpositie, die is aangegeven door parameter b 
(hexadecimaal) komt op de 8-bit parallelle uitvoerpoort. 

Als de ”Rb’’-instructie niet wordt gebruikt, zal de uitvoerpoort actief laag 
zijn. 

Het uitvoerpoort penschema is zoals in tabel 3.7 aangegeven. 


Deze instructie kan worden gebruikt om de geheugenlokaties van de robot- 
computer uit te lezen. 





Pennummer 





Uitgangssignaal 





5 Ì 








Tabel 3.7 

3.5.3 Input switch 

Input switch high level (SWH) 
Inputvorm: U a3,a2,al,a0 
Voorbeeld: PRINT #4,”’U 1,1,1,0” 


De uitgangspen van connector 4 zal hoog H of laag L zijn al naargelang de 
toestand van de input switch high level (SWH) en a. De relatie tussen de 
switch-pen en de uitgangspoort is weergegeven in tabel 3.8. 


Als de parameter a = 1 en de switch-input = H dan is de uitgangspen van 
connector 4 ook H. 

Als de switch-input L is dan is de uitgang ook L. Indien de parameter a = 0 
dan is de respectievelijke uitgangspen van connector 4 laag onafhankelijk 
van de switch-input-pen. De input SW-pennen zijn op het PC board connec- 
tor 7-10. 



















DB3 (1) a3 
DB2 (2) a2 
DBI (3) al 





DBO0 (4) a0 
Tabel 3.8 

Input switch low level (SWL) 

Inputvorm: V a3,a2,al,a0 

Voorbeeld: PRINT #4,” V 1,0,0,1°’ 

Als de parameter a = 1 en de SW-input is H dan is de respectievelijke uit- 
gangspen van connector 4 L. 


Anderzijds zal hij bij een SW-input L en a = 1 hoog worden. 


Indien de parameter a = 0 dan is de respectievelijke uitgangspen laag, onaf- 
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hankelijk van switch-input-pen. De samenhang tussen de SW-input-pen en 
de uitgangspoort zijn dezelfde als in tabel 3.8. 


3.6 Foutmeldingen 


De eerste zaken om na te kijken als de robot storing vertoont zijn: 
— is de voeding ingeschakeld? 

— is de reset-knop ingedrukt? 

— is de kabel tussen de robot en de computer goed aangesloten? 
— is de parallelle poort aangeschakeld? 

— staat de CS-113 op nulpositie? 

— reageerde de robot bij de testprogramma’s? 

— zijn de juiste inputvormen gebruikt? 


Indien na deze controle de robot nog storing vertoont, neemt u contact op 
met: 

Sciento B.V. 

Speldenmakerstraat 10C 

5232 BG ’s-Hertogenbosch 

Nederland 

Tel.: 073 - 424055 

Telex: 50766 


voor België: 
Sciento Belgium pvba 
Amerikalei 220 bus 8 
2000 Antwerpen 
Tel.: 03 - 2379365 
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4. CARTESIAANSE COÖRDINATEN 


De positie van de klauw van de robot wordt bepaald ten opzichte van de X-, 
Y- en Z-richting van het rechthoekig assenkruis (figuur 4.1). 

Uitgaande van de gegeven X-, Y- en Z-coördinaten die de positie van de 
klauw bepalen, de opening van de klauw en de pitch- en rollhoek worden in 
dit hoofdstuk de gewrichtshoeken berekend. 

Uitgaande van de gewrichtshoeken bepalen we dan het aantal stappen die el- 
ke motor ten opzichte van de nulpositie moet uitvoeren. 


bovenarm 
schoudergewricht z-as 
ellebooggewricht 


BN onderarm 
‚ | 
SF 

Te 


basis=- ee 
Sl gewricht 4D, 


polsgewricht 
LA  P 
A 
el men an 


yes 


frame 





basis 


x-as 


4.1 Positie van de robothand in rechthoekig assenkruis 


Alvorens de relatie tussen de gewrichtshoeken en het cartesiaanse coördina- 
tenstelsel te kunnen bepalen, is het noodzakelijk de relaties tussen de ver- 
schillende onderdelen van de robot vast te leggen. Dit geschiedt aan de hand 
van het kinematisch model van de robot, die in een bepaalde positie staat (fi- 
guur 4.2). 
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Z-as xy z) 





X- as 


4.2 Kinematisch model van de robot. 


4.1 Van de cartesiaanse coördinaten naar 
de gewrichtshoeken 


Nemen we figuur 4.3 als basis dan kunnen we stellen dat: 
Z=H + L, sin 8, + L sin 03 + LL sin P 
RR = Li cos 0, + L cos 03 + LL cos P 


waarbij 8), 03 de respectievelijke gewrichtshoeken zijn en P de pitch-hoek 
van de klauw voorstelt. 


Verplaatsingen van de klauw, door middel van het polsgewrichtdifferentieel 
(zie figuur 4.4) die 84 en Bs bepalen, kunnen wiskundig als volgt weergegeven 
worden. 


De pitch-hoek P : P = ( 
je ) 





Z-as | RR 


L1cos02 | L cos 03 LL cosP 


eindpunt 






L1 sin 02 


4.3 Basisfiguur zijaanzicht 


zijaanzicht 
differentiaal 
tandwielstelsel 
Be +R 
pitch-as 
vooraanzicht 


4.4 Polsdifferentieel 
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& ade OE semasa acid ate hin rts 








De roll-hoek R : R = (Ge) 


Bekijken we de basisfiguur van boven (figuur 4.5) dan kunnen we de X en de 
Y bepalen namelijk: 


X 
Y 


RR cos 0, 
RR sin 0, 


Door toepassing van bovenstaande formules kunnen we dus de positie van 
de punt van de grijper bepalen in de ruimte onder voorwaarde dat we de 
aslijn door de eerste robotas de O-lijn of Z-as noemen en het steunvlak = 0 
(X-as) in de hoogte positie. 


Y-as 






„eindpunt 







RR sin 01 


X-as 





RR cos 61 


4,5 Basisfiguur van boven bekeken 


Indien we een korte opsomming geven van de bepaling van de cartesiaanse 
coördinaten X, Y en Z in functie van de gewrichtshoeken 6 is deze als volgt: 


Os + 04 


nl ne 


2- R = ( 


Os — 04 
me met. 
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-3- RR = Li cos, + L cos 83 + LL cos P 


à 
X 
Il 


RR cos 6, 


jn 
an 
Il 


RR sin 6, 


-6- Z= H + Lisin6, + Lsin03 + LL sin P 


4.2 Van de gewrichtshoeken naar de car- 
teslaanse coördinaten 


In vele gevallen is het belangrijk het aantal stappen van de motoren te bepa- 
len in verband met een wijziging van de positie van het eindpunt van de grij- 
per in het cartesiaanse coördinatenstelsel. 

Hiervoor dienen we vanuit de bekende X-, Y- en Z-positie-gegevens, meestal 
uitgebreid met gegevens in verband met de pitch- en de roll-hoeken, de hoe- 
ken 01, 02, 03, O4 en 05 te bepalen. 


Alvorens de berekeningen te starten, dienen we duidelijk de positie en oriën- 
tatie te bepalen in relatie tot het eindpunt van de robot in het rechthoekig as- 
senstelsel. 

— Als eindpunt nemen we het middenpunt in het eind van de grijper. 

— X is de afstand van het gewenste punt gemeten vanuit de verticale draaias. 
— Y is de afstand van het gewenste punt tot de X-as in een horizontaal vlak. 
— Zis de verticale afstand tot het tafeloppervlak waarop de basis van de ro- 

bot geplaatst is. 





4,6 Verschillende oriëntatiemogelijkheden van de robotklauw 
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X, Y en Z bepalen de positie van het punt in de ruimte. De oriëntatie van de 
grijper is hiermede echter niet bepaald. Zoals uit de figuur 4.6 blijkt, kan 
eenzelfde punt in de ruimte benaderd zijn door verschillende standen van de 
klauw. 

Deze bepalen op hun beurt de gewrichtshoeken. 

De oriëntatie van de hand is bepaald door: 

— P de gewenste pitch-hoek 

— R de roll-hoek 

Beide hoeken worden uitgedrukt in graden. 


B,, of de hoek die de basis dient in te nemen, kan men berekenen uitgaande 
van RR. 


RR = V et Y?, zie figuur 4.7 
waaruit 6; = arctg Go waarbij 6, J—'m/2, ‘zr /2[ 


84 en Os bepalen we uit de gegevens van P en R gezien 


0s +0 
a en 
Os — 0 
rn 


Geeft: Os = P + R 
04 =P — R 


waarbij P en R gegeven is in het rechthoekig assenstelsel. 


q 


6, 


basis Pa 


4.7 Berekening van de hoek 6, 
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Z-as 






ELLEBOOG 


SCHOUDER 


X-as 


4.8 Berekening van de hoeken 8, B, 


Om nu praktisch verder te werken, maken we gebruik van figuur 4.8. 

We verleggen het nulpunt naar het punt van het schoudergewricht. De coör- 
dinaten van het uiteinde van de elleboog ten overstaan van dit nulpunt wor- 
den voorgesteld door Ro en Zo. 





Ro 
Zo 


RR — LL cos P | 
LLsinP — H 


Nu Ro en Zo bepaald zijn, kunnen we de hoeken 6, en 03 bepalen. 
De hoek fB in figuur 4.8 wordt: 


= Zo 
fB = arctg ( Re ) 
‚ De afstand tussen het nulpunt en het punt (Ro, Zo) is: 


A= VR? + Zo 


Aangezien L;, L en A bepaald zijn, kan men 6; berekenen met de consinus-_ 
regel: 
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% 


Ardea si 


ee 5 


dus @ = arccos (cos a ) 
waarbij 8 wordt: 02 = « + B 


In dezelfde driehoek wordt 6: 


Biel ek 


cos 0 = 2 L, L 


waarbij 6 = arccos (cos 6) 

_ Lj? +L? — A? 
dus 6 a arccCos SEE 
Aangezien 6, + 03 + 0 = 180 

wordt 03 = 180 — (0 + 05) 

Men dient echter te noteren dat de ellebooghoek 6; is bepaald als de hoek bo- 


ven de horizontale lijn waardoor we dus het teken van 03 dienen te wijzigen 
waardoor dus 


03 = —180 + (@ + 05) 
In de vorige formules was LL als een constante aangenomen. Deze is echter, 


zoals uit figuur 4.9 blijkt een functie van de opening van de klauw. Het ver- 
band tussen de grijperlengte en de grijperopening volgt uit figuur 4.9. 





4.9 Invloed van de grijperopening op de grijperlengte 
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Lag = La + LB 
LL= Li + Vin (Gey 


Als we een opsomming geven voor de bepaling van de gewrichtshoeken in 
functie van de cartesiaanse coördinaten van een punt, luidt deze als volgt: 


RR = VX? + y? 


01 = arctg Go) 





04 =P — R s 


05 =P +R 





LL = (La + LB) + 
Ro = RR — LL cos P 
Zo =Z -LLsinP — H 
A= VR + Zo 

A = arccos 

5 Zo 
A 
0, = a + f 

2 La L 

03 = —180 + (0 + 09) 


4,3 BASIC-programma 


De positionering van de robot wordt bepaald ten opzichte van de X-, Y- en 
Z-richting van het rechthoekig assenkruis. 

De bewegingen vinden plaats ten opzichte van de nulpositie, die als coördi- 
naten heeft (figuur 4.10): 


X = 361 mm 

Y = 0 mm 

Z = 358 mm 
P. R = 0 graden 
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Hand gesloten dat wil zeggen G =0 
of 8, = 0°.0, = 53°.0; = —7°. 04,05 = 0 


Het BAsIC-programma zal, uitgaande van de gegeven X-, Y- en Z- 
coördinaten de opening van de klauw G, de pitch- en roll-hoek, de gewrichts- 
hoeken en het nodige aantal stappen berekenen. 






Oprer= 53° XRrer = 361 
Ozrer =-7° YreF= OQ 
Prer= 00° ZreF = 358 


4.10 Coördinaten van de nulpositie 


Uitgaande van de nulpositie zal dan de robot naar de gewenste stand gaan 
met een nauwkeurigheid van 0.9 mm. Deze tolerantie is te wijten aan de spe- 
ling van de overbrengingskettingen! 

De maximale gewrichtshoek die een functie is van het aantal stappen van de 
motor is weergegeven in tabel 4.1. 


Maximale verplaatsing - stappen vanaf nul 


motor onderdeel grad/stap + richting — richting max.graden 
MI basis 0.12 1000 CW _ 1000 ACW 120° 


M2 schouder 0.12 600 600 70° 
opwaarts neerwaarts 


M3 elleboog 0.08 600 600 50° 
opwaarts neerwaarts 


M4 90° pitch 


MS pols 0.05 1800 1800 360°roll 


M6 klauw 0.1 1800 1800 open = 
hand 10 cm max. 
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Positie precisie 0.9 mm 
Laadcapaciteit max. 500 gram 
Bewegingssnelheid max. 400 mm/sec 


Tabel 4.1 


Als M4 en MS de input heeft (1800, — 1800) dan zal de klauw 90° naar bene- 
den bewegen. Indien de input (— 1800.1800) is dan zal de klauw met de klok 
mee 90° bewegen. Wanneer M4 » MS of M4 « M5 dan zal de beweging van 
het buigen en draaien van de hand tegelijk plaatsvinden. 


Daar de verplaatsing van de hand gerefereerd wordt ten opzichte van de elle- 
boog zal de pitch-hoek in het rechthoekig assenkruis een functie zijn van 03. 
Als bv. 83 = 0° dan kan de pitch-hoek maximaal 90° zijn. Daarentegen als 
8} = — 90° dan is de pitch-hoek maximaal +0° en — 180° (figuur 4.11). 





4.11 De pitch als functie van de gewrichtshoek 63 


Het BAsIC-programma laat toe de hoeken 0;, 02, 03, 04 en 65 die in de pro- 
grammalisting voorgesteld worden door TI, T2, T3, T4 en T$ te berekenen 
vanuit een punt in het cartesiaanse stelsel waarbij tevens de mogelijkheden 
van begrenzing is ingebouwd. De begrenzingen zijn weergegeven in tabel 4.2 
en figuur 4.12. Deze werden proefondervindelijk vastgelegd en kunnen door 
de gebruiker zelf aangepast worden. 


Max. waarde 


Pos. neg. 


Y [420 —90] [[— 420 — 90] 





Tabel 4.2 
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4.12 De begrenzingen van de robot 


De pitch- en roll-hoek zullen ook de maximale waarde van de bewegingen be- 
palen. Het kan bijvoorbeeld zijn dat een punt wel tussen de grenzen ligt, 
maar door een keuze van P en R niet bereikbaar is. 


Het BAsIC-programma draagt de naam HOEK. (fig. 4.13). 
65 








Regel 1-50 


In dit stuk van het programma wordt een kleine inleiding gegeven (GOTO 
6000) waarna de interface wordt geïnitialiseerd. 
Na een klein testprogram, waarbij de basis 500 stappen gaat bewegen, wor- 
den de constante lengten enzovoort, ingelezen. 


Regel 60-260 


Hier worden de coördinaten X, Y en Z, de opening van de klauw, de pitch-en 
roll-hoek (beide in graden) ingelezen. Dan wordt de eerste begrenzing gecon- 
troleerd. 


Indien aan één voorwaarde is voldaan, worden deze coördinaten niet aange- 
nomen, GoTO 500. 

Men kan dan een keuze maken, ofwel men geeft nieuwe coördinaten ofwel 
men gaat naar een eerder berekende positie. 


Indien niet aan een voorwaarde is voldaan, worden de gewrichtshoeken bere- _ 


kend. 
Regel 270-570 


Na het berekenen van de hoeken en controle op de begrenzing worden de 
gewrichtshoeken op de monitor gebracht. Deze zijn in graden uitgedrukt. 


Regel 700-808 


In dit deel worden de stappen berekend om naar de gewenste positie te gaan. 
Het aantal stappen wordt berekend ten opzichte van de nulpositie. Als alleen 
B, verandert dan zal ook 63 veranderen. Deze verandering gebeurt niet bij 
een industriële robot zodat bij de berekening van 03 deze een correctie moet 
krijgen. Deze correctie wordt proefondervindelijk vastgelegd en kan steeds 
door de gebruiker worden bijgesteld (regel 731). Na het aantal stappen in de 
positie-instructie PK‚S1,S2,S3,S4,S5,S6 op de monitor. 


Regel 810-5900 


Vanaf nu heeft de gebruiker verschillende mogelijkheden. Hij of zij kan nu _ 


de robot een aantal keren naar de gewenste positie laten gaan, òf terug naar 
de nulpositie. 

Men kan naar een andere vooraf berekende en gedefinieerde positie gaan. Of 
men kan een andere positie berekenen. 

Moet de robot terug naar een andere vooraf berekende positie dan zal deze 
positie weer op de monitor verschijnen in de vorm van de P-instructie. 
Vanaf dan heeft de gebruiker de voorafgaande mogelij kheden, uitvoeren, te- 
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rug naar home-positie enzovoort. 


Opmerkingen 


Aangezien bij bepaalde reeksen van robotten de speling van de overbren- 
gingskettingen niet direct weg te nemen is, zal de positienauwkeurigheid 
klein zijn (0.9 mm). Daar moet rekening mee gehouden worden bij het bepa- 


len van de eindpositie en vooral bij het tekenen van bepaalde figuren zoals 
cirkels enzovoort. 





4.14 Invloed van het ontbreken van een zesde vrijheidsgraad 


Doordat de robot CS-113 vijf vrijheidsgraden heeft en geen grote nauwkeu- 
righeid, worden de prestaties van een professionele industriële robot slechts 
gedeeltelijk benaderd. Dit is in te zien met een volgend voorbeeld (figuur 
4.14). Een voorwerp liggend op een bepaalde plaats (figuur 4.14a) wordt ver- 
plaatst naar een positie (figuur 4.14b). Veronderstel dat alleen X en Y veran- 
deren. Het resultaat is dat het voorwerp (plaat) verdraait tegenover de begin- 
situatie. Deze verdraaiing is te wijten aan de ontbrekende vrijheidsgraad met 
andere woorden zodra de robot de hoek 6, verandert, ondergaat het stuk een 
verdraaiing. 
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OON PWNEO 


REM ***6000 = INLEIDING *** 
GOTO 6000 
POKE 53280,15:POKE 53281,15 
REM *** LADEN CENTR 7000 *** 
PRINT CHR$ (147) 
IF PEEK(29520)=120 THENS 
LOAD"CENTR 7000",8,1 
POKE 52,96:POKE 54,96:POKE 56,96 
SYS 29520:PRINT" (CLR) " 
REM* % % TEST* % 
OPEN 4,4,7 
PRINT#4, "Z" 
PRINT#4, "55" 
PRINT#4,"M500,0,0,0,0,0" 
PRINT#4, "N" 
CLOSE 4 


REM *** GEGEVENS ROBOT *** 
PRINT CHR$ (147) 
H=217:L1=197:L=150: LAB=54 
L2= 45:G0=38:C=180/1 

REM X**INLEZEN X,Y,Z,G,P,R *** 


0 PRINT"DE NULKOORDINATEN ZIJN :361,0,358,0 


102 PRINT 


5 PRINT « TYPE IN : X , Y , ZZ, 6" 


106 PRINT 


0 INPUT" En PR OVAA 


120 IF X>420 OR Y>420 ORY<-420THENGOTOS5 000 
130 IF Z>550 ORZ<-70 THEN GOTO 5000 
140 IF G<-100 ORG>20 THEN GOTO 5000 


16 


27 


O IF (Y<90 OR Y<-90)AND X<9 ANDZ<300THEN 
GOTO 5000 


O PRINT 

O INPUT" TYPE IN P‚,R IN GRADEN';P,R 
O0 PRINT 

0: rd | 
O REM ** BEREKENEN VAN DE HOEKEN **% 
5 
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P=P/C:R=R/C:REM X**R,P IN RAD*** 
RR=SOR(X* X+Y*Y) 

IFX=OTHEN T1=SGN(Y)*r/2:GOTO 320 

REM ***T1I=BASIS*** 

T1= ATN(Y/X) 

IF XXOTHEN T1=T1+SEN(Y) *r 

IF T12120/C OR T1<-120/C THEN GOTO 5000 
IF R=0 THEN T4=-P:T5=P:GOTO 350 

IF P=0 THEN T4=-R:T5=-R:GOTO 350 

REM “*EPITCH-ROLLE*% 

T4= R-P:T5= (P+R) 

IFT4<--360/C OR T4>360/C THEN GOTO 5000 
IF T5<-360/C OR T5>360/C THEN GOTO 5000 
T=(ABS(G) -G0) /2 

LL=LAB+ SOR((L2*L2) -(T*T)) 
RO=RR-LL* COS (P) 

20=4-(LL*SIN(P))-H 

IF RO<O THEN GOTO 5000 

IF RO=0 THEN B=rr/2:ELSE:B=ATN(Z0/RO) 
A=SOR( (RO*RO) +(20*20) ) 
CO=((A*A) +(LI*LI) -(L*L)) /(LI*A* 2): 

IF CO>1 THEN GOTO 5000 

AL= —-ATN(CO/SOR(—-CO*CO+1)) Hir /2 

REM “4% AL STEEDS + MER 


O T2=B+ AL 


REM *** T2 HOEK SCHOUDER**% 

IF T2>125/C ORT2<-25/C THEN GOTO 5000 
CA= (—(A*A) +(LI*LI) +(L*L) ) /(L1*L*2) 
TH=-ATN (CA/SOR(—CA*CA+1)) +rr /2 

REM *** T3 HOEK ELLEBOOG*** 

T3= =r+TH+T2 

IFT3=<OANDP >= OANDP-T3 >ir /2THENGOTO5 000 
IFT3 >=0ANDP<=OANDT3-P Xr /2THENGOTO5 000 
IF ABS(P)-ABS(T3) >= 1r/2 THEN GOTO 5000 
PRINT"T1I=";INT(T1*C) 

PRINT" T2=";INT(T2*C) 
PRINT"T3=";INT(T3*C) 
PRINT'"T4="; INT (T4*C) 

PRINT"T5="; INT(TS*C) 


REM *% STAPPEN** 


S(1) =INT(T1*C/(-0.12)) 
IF ABS(S(1)) >1100THEN 5000 
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720 
7235 
731 


fd 
740 
750 
760 
762 
763 
764 
765 
766 


(2) =INT((T2*C-53.48) /0.12) 

IF ABS(S(2)) > 7O00THEN 5000 
D(3)=INI((TH*C-119.87+(T2*C-53.48) *32/6/12) 
/0.08) 

IF S(3) 26000R S(3)<-1300THEN 5000 
S(4)=INT(TA*C/O.1 ) 


S(S)=INT(TS*C/O.1 ) 

59(6)=G*18 

PRINT" AANTAL GEBRUIKTE POSITIES' ;V 
PRINT 

INPUT"WELKE POSITIE IS DIT P=1 TOT 10 ";K 


POKE 198 ,0 

IF K>10 THEN GOTO 762 
IF Kò=V THEN V=V+1 
B$(K)="P"+STRS$ (K) 

FOR I=l TO 6 

B$ (K) =B$(K) +", "+STR$ (5(I)) 
NEXT'I 

PRINT 

PRINT B$(K) 

PRINT 

REM **%* UITVOERING **%* 


PRINT"BEVEL UITVOEREN ? (JAN) 
POKE 198,0 

GET D$:IFD$="N" THEN GOTO 900 

IF D$<>"J"THEN GOTO 820 

OPEN 4,4, 7 

PRINT#4, "55" 

PRINT#4,B$ (K) 

G$(K) ="G"+STR$ (K) 

PRINT#4,G$ (K) 

CLOSE 4 

PRINT"MOET DE ROBOT TERUG NAAR NUL (J/N) " 
POKE 198,0 

GET A$: IFA$="N" THEN GOTO 950:POKE198,0 
IF A$ <>"J"GOTO 910 

OPEN 4,4,7 

PRINT#4, "N" 

PRINT'"J= DEZELFDE BEWEGING" 
PRINT'"R= ANDERE KOORDINAAT" 
PRINT"A= ANDERE POSITIE" 

POKE 198,0 

GET A$:IFA$=""THEN GOTO990 








IF A$="J"THEN CLOSE4 
IF Ag$="R"THEN CLOSE4 
IF A$="A"THEN CLOSE4 


:GOTO 840 
:GOTO 25 
:GOTO 1055 


REM*** ANDERE POSITIE *** 


PRINT CHR$ (147) 

PRINT"AANTAL GEBRUIKTE POSITIES";V 
PRINT 

INPUT"NAAR WELKE POSITIE WENST U TE GAAN ” 
IFK>V THEN GOTO 1070 

PRINT 

PRINT B$(K) 

PRINT 

CLOSE 4 

GOTO 810 

END | 

PRINT"*** BUITEN BEREIK***" 

PRINT: PRINT: PRINT 

GOTO 960 


REM KEK INLEIDENDE TEKST **% 


POKE 53280,0:PRINTCHR$ (30) 

POKE 53281,0:PRINTCHRS$ (147) 
PRINT CHR$(18) " 
PRINT CHR$(18)" 
PRINT CHR$(18) " 


CARTESIAANSE GEOMETRIE 


PRINT:PRINT:PRINT 

PRINT" DE ORIENTATIE VAN DE ROBOT WORDT " 
PRINT 

PRINT" BEPAALD T.O.V DE X-Y-EN Z-RICHTING'" 
PRINT | 

PRINT" VAN HET RECHTHOEKIG ASSENKRUIS. " 
PRINT 

PRINT" DE BEWEGINGEN GEBEUREN T.O.V VAN 
PRINT 

PRINT' DE NULPOSITIE „DIE ALS COORDINATEN" 
PRINT | 

PRINT" HEEFT : X= 361 MM Y=0 MM ü 
PRINT 

PRINT" Z= 358 MM P=R=0 GRADEN á 
PRINT:PRINT:PRINT 


PRINT" “Xx SPATIE VOOR VERVOLG **« ii 
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6250 
6259 
6260 
6265 
6270 


. READY. 


4.13 BAsic-programma HOEK 


12 


GETA$:IFA$=" "THEN GOTO 6150 
PRINTCHR$ (147) :PRINT:PRINT:PRINT 


PRINT" DIT PROGRAMMA ZAL,UITGAANDE VAN n 
PRINT 

PRINT" DE GEGEVEN X-Y-EN Z-COORDINATEN,  " 
PRINT 

PRINT" DE OPENING VAN DE KLAUW (G) EN DE " 
PRINT | 
PRINT" PITCH- EN ROLL-HOEK,HET NODIGE AANTAL" 
PRINT | 
PRINT" STAPPEN BEREKENEN. à 
PRINT 

PRINT" UITGAANDE VAN DE NULPOSITIE ZAL DAN" 
PRINT | 
PRINT" DE ROBOT NAAR DE GEWENSTE STAND GAAN." 


PRINT :PRINT:PRINT 


PRINT" xxx SPATIE VOOR VERVOLG *** he 
GETA$:IFA$=" "THEN GOTO 25 
GOTO 6265 





5. REALTIME-BESTURING VAN DE 
ROBOT CS-113 | 


In het vorige hoofdstuk werd besproken op welke manier we de robot kun- 
nen besturen vanuit een cartesiaans coördinatenstelsel. Een punt (positie van 
het eindpunt van de klauw) wordt ingegeven en het programma berekent het 
aantal stappen, te geven aan elk van de zes motoren. 


Dit hoofdstuk echter behandelt het besturingsprobleem vanuit een ander 

oogpunt. Industriële robots hebben de mogelijkheid om onder controle van 

een operator, dus niet automatisch, naar een bepaald punt te gaan. Dit is 

uiterst handig als men de coördinaten van dat punt niet kent. De robot leert d 
deze beweging aan en kan deze later wederom uitvoeren maar nu automa- Ì 
tisch. 


De CS-113 bezit door zijn instructies HERE en Go ook de mogelijkheid om 
respectievelijk een bepaalde stand in zijn geheugen op te slaan en later weer 
dezelfde stand aan te nemen. Het REALTIME-programma staat u toe via de | 
overige instructies dergelijke punten te bereiken, op te slaan en daarna de be- | 
weging te reproduceren. 





Het programma werkt onder SIMON’s BASIC op een Commodore-64. Er dient 
dus in eerste instantie voor gezorgd te worden dat deze uitgebreide BAsIC- 
versie aanwezig is in de computer. Dit kan gebeuren vanuit de diskdrive of de 
cassette. Bovendien moet de robot aangeschakeld zijn om de bevelen van de 
centronicsinterface te beantwoorden. 


5.l Starten van het programma 





Laad en RUN het programma REALTIME ROBOT. Dit programma zoekt zelf een 
assembler routine op van de schijf en laad deze in de computer. Dit gebeurt 
in regel 10: 


10 LOAD ”CENTR 7000” ,8, 1 
Het is dus een noodzaak deze routine CENTR 7000 op schijf te hebben. Indien 
deze niet op schijf maar wel op cassette beschikbaar is moet men het pro- 
gramma wijzigen door: 

10 LOAD ”CENTR 7000” ,1,1 
Ter controle zal voor het hoofdmenu het bericht PARALLEL PRINTER POOR! 


AAN!!! heel even verschijnen. 
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Op het scherm moet nu de volgende figuur verschijnen (fig. 5.1). De robot 
zal tevens een controlebeweging uitvoeren (draaiing van 60° CW). 


wers HET TRE KI 
SLA TEE | EEL 
Dn A ks. ee 





fig. 5.1 Het hoofdmenu 


5.2 Hoofdmenu 


Op dit menu staan de meest bruikbare instructies van de robot, de maximale 
stappen (absolute waarde) en de huidige positie van elke motor. Men kan de 
instructies kiezen door de eerste letter van deze instructie in te drukken. 
Merk op dat deze letters onderstreept zijn, zoals in de loop van het program- 
ma elk mogelijk antwoord aangegeven zal worden door een onderstreping. 
Een bevel dat volledig is en doorgestuurd wordt komt te voorschijn in de ba- 
sis van de robot. 


5.2.1 De l-toets-commando’s 

Hierbij bestaat een volledig bevel uit het indrukken van I-toets. Deze com- 
mando’s zijn ZERO, NEST, OPEN, CLOSE en QUIT. Voor verdere verklaring van de- 
ze instructies zie ook hoofdstuk 3. 


ZERO » Deze instructie beveelt de robot de huidige positie, ook al is dit 
niet de aanbevolen stand, als nulpositie te beschouwen, en zal 
tevens in de CMB-64 de bijgehouden stappen van de motor wis- 
sen. 


NEST : De robot gaat terug naar de laatst ingegeven nulpositie en de 
CMB-64 stelt de stappen = 0. | 
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OPEN CLOSE : De robot opent en sluit de klauw, en het aantal stappen van mo- 


QUIT 


tor zes (onderaan rechts) wordt respectievelijk — 1800 en 0. 


: Hierdoor verlaat u het REALTIME-programma, de robot wordt 


echter terug in zijn laatst ingegeven nulpositie gezet. Merk op 
dat het programma aanwezig blijft in het computergeheugen 
evenals de centronics routine en SIMON'S BASIC. 


5.2.2 De  2-toets-commando’s 
Een bevel is nu pas volledig als na het indrukken van de instructie ook nog 
een antwoord is gegeven op het submenu. 


LIMIT 


SPEED 


HERE 


GO 


: Men kiest tussen een begrenzing op het maximale bereik van de 


motoren (Limit 1) of helemaal geen begrenzing (Limit 0). 


: Hiermee wordt normaliter de snelheid van de beweging in- 


gesteld. In het REALTIME-programma zal de instructie echter te- 
gelijkertijd de grootte van de stappen bepalen waarmee de 
MOVE-instructie wordt uitgevoerd. Voor verdere informatie ver- 
wijzen we naar 5.2.3 De MOVE-instructie. 


: Men kan door middel van de HERE-instructie de robot zijn hui- 


dige positie laten opslaan. De CBM-64 op zijn beurt zal dit ook 
doen. Het maximale aantal posities is in het REALTIME- 
programma echter beperkt tot negen. De nog niet gedefinieerde 
posities verschijnen in het submenu als een helder karakter. 
Reeds gebruikte posities verschijnen in een andere kleur maar 
kunnen steeds geherdefinieerd worden. Dit is trouwens de reden 
waarom zij nog in het submenu worden opgenomen. 


: De door de HERE bepaalde posities kunnen door middel van de 


GO-instructie weer ingenomen worden. In het submenu worden 
deze posities helder aangegeven, en de nog niet gedefinieerde, 
minder zichtbaar, komen overeen met de nulpositie. 
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5.2.3 Het MOvE-commando 
Bij het indrukken van de M-toets krijgt men het volgende beeldscherm (fig. 


pe 





fig. 5.2 Het MOVE-submenu 


Er zijn zeven mogelijke sub-submenu’s die elk één of twee motor(en) aanstu- 
ren: 


l : BASIC, + = CW, — = ACW 
2 : Schouder, + = opwaarts, — = neerwaarts 
3 : Elleboog, + = opwaarts, — = neerwaarts 
4 : Rechterpolsgewricht, + = draaiing CW en pitch omlaag 
— = draaiing ACW en pitch omhoog 
5 : Linkerpolsgewricht, + = draaiing CW en pitch omhoog 
— = draaiing ACW en pitch omlaag 
6 : Klauw, + = dicht, — = open 
45: Pols, + = draaiing CW 


— = draaiing ACW 
«shift» + = pitch omlaag 
«shift» — = pitch omhoog 


Het is niet noodzakelijk een MOvE-bevel volledig te definiëren indien men 
reeds in het MOvE-submenu werkzaam is. De eerder ingedrukte toetsen kun- 
nen steeds gebruikt worden in een volgend MOvE-bevel: 
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Voorbeeld: 


beter best 
MI + MI + MI + 
MI + 1 + + 

of 

M3 — M3 — M3 — 
M4 + 4 + 4 + 
M4 + 4 + + 
MA + 2 + 2 + 
M2 — 2-— — 
M2 — 2 — _— 
M45 + 45 + 45 + 


De laatst aangesproken motor blijft hiervoor steeds aangegeven door een 
groen cijfer. Men kan op elk moment de motorkeuze veranderen. Het aantal 
stappen die elke motor uitvoert bij een bevel is bepaald door de sPEED- 
instructie, namelijk de sPEED-parameter (1 …. 5) tot de derde macht. 
Voorbeeld sPEED 5 —_ —_— 125 STAPPEN. 

Wanneer een motor meer stappen in een bepaalde richting moet uitvoeren is 
het mogelijk de + of — toets constant ingedrukt te houden. Wanneer men 
de motor naar een positie wil sturen buiten het maximaal aantal stappen dan 
zal de gevraagde positie, groter dan de maximale, in het rood oplichten. De 
operator heeft nu twee mogelijkheden: 


1. de motor moet naar de gevraagde positie bewegen 
> men drukt de return-toets in 

2. de motor gaat naar de maximale stand 
—_—_——> men drukt de spacebar in 


5.3 Voorbeeld 


Zorg ervoor dat de robot in de aangewezen nulstand staat door middel van 
testmode 1 (zie hoofdstuk 3). 

Geef het ZERO-commando (toets Z) 

Stel de begrenzing van de robot in: L 1 

Maak een keuze voor de snelheid: voorbeeld S 5 

Indien er geen keuze gemaakt is voor de snelheid wordt automatisch snelheid 
|l aangenomen, en zijn de verplaatsingen van de motoren dus 13 = Ì. 
Beweeg de robot naar de gewenste plaats waar bijvoorbeeld een voorwerp 
ligt omtegrijpen: M1 +, +,2 —,.…. Plaats de robot met geopende grijper 
boven het voorwerp O en plaats een referentiepositie H 1. Sluit de grijper C 
en plaats een referentiepositie H 2. 
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Beweeg de robot naar een plaats waar het voorwerp moet komen: M 1 —, — 
EEN . Plaats een referentiepositie H 3. Open de grijper O, ofwel M 6 —, 
— …. « Plaats de robot met geopende grijper boven het voorwerp en plaats 
een referentiepositie H 4. 

De beweging kan nu herhaald worden door de commando’s G 1, G 2, G 3, 
G 4, enzovoort. 


5.4 Conclusie 


We kunnen dus reële problemen met de hand oplossen, zonder de ruimte- 
coördinaten van de voorwerpen te kennen, en de robot verschillende bewe- 
gingen aanleren. 


Een nadeel van het programma (en tevens een voordeel) is dat de bewegingen 
in stappen moeten worden uitgevoerd. Het zal de aandachtige gebruiker ech- 
ter niet ontgaan zijn dat hij met behulp van dit programma naar een bepaald 
punt kan gaan en hiervan de motor-coördinaten kan aflezen van de positie- 
kolom op het scherm. Zo dat hij in een eigen geschreven programma de be- 
weging in één keer uit kan voeren. Men hoeft dus niet met de meetlat afstan- 
den te meten en om te zetten in motor-coördinaten. 


Het programma wordt hierna gegeven en is naar eigen goeddunken aan te 
passen. Pas wel op voor PEEK’s en POKE’s die om allerlei redenen in het 
programma zijn ingelast. 


5.5 BASIC-programma 


1 REM *** ROBOTTEKENING **« 

2 IF PEEK(29520)=120 THEN 30 

10 LOAD"CENTR 7000",8,1 

30 POKE 52,96 

40 POKE 54,96 

50 POKE 56,96 

53 SYS 29520 

60 MM(1)=1000:MM(2)=600:MM(3) =600 

70 MM(4)=1800:MM(5)=1800:MM(6) =1800 

100 PRINT" (CLR) " 

105 COLOUR14,2:HIRESO,1:MULTI1,6, 7 

110 REC 2,2,156,12,3 

120 PAINT3,10,2 ke 
130 TEXTO,5," C-5113 REALTIME “"‚1,0,8 
140 N= 9:K=l:GOSUB 700:REM HOOFDMENU 





12 TEE. SN 





P$= "MAX POS" 

REC 1,151,75,14,1 
REC83,151,75,14,1 
PAINT2,152,3 
PAINT84,152,3 

TEXT 3, 155,P$,2,1,8 
TEXT 85, 155,P$,2,1,8 


TEXT 1, 170,"1000",1,1,8 
TEXT 83, 170," 1800",1,1,8 
TEXT 1, 180," 600",1,1,8 
TEXT 83, 180,"1800",1,1,8 
TEXT 1, 190," 600",1,1,8 
TEXT 83, 190,"1800",1,1,8 
RX=3:RY=124 

GOSUB 340:REM TEKENING ROBOT 
GOTO 5000 


REM *** EINDE TEKENPROGRAMMA *** 


REM *** ROBOTTEKENING *** 
REM *** ONDERSTEL *** 

REC RX,RY,50,15,1 
PAINTRX+1,RY+1, 2 


REM *** LICHAAM **« 

LINE RX+10,RY-22,RX+10,RY-2,1 
LINE RX+10,RY-2,RX+50,RY-2,1 
LINE RX+50,RY-2,RX+50,RY-40,1 
LINE RX+50,RY-40,RX+30,RY-40,1 
LINE RX+30,RY-40,RX+10,RY-22,1 
PAINTRX+11,RY-3,2 
CIRCLERX+37,RY-28,5,8,1 
CIRCLERX+24,RY-18,4,7,1 


REM X** BOVENARM *** 

LINE RX+35,RY-40,RX+56,RY-73,1 
CIRCLERX+60,RY-70,4,7,1 

LINE RX+63,RY-66,RX+50,RY-30, 1 
PAINT RX+40,RY-42,2 

PAINT RX+60,RY-70,2 


REM *** ONDERARM *** 
LINE RX+61,RY-76,RX+81,RY-68, 1 
CIRCLE RX+80,RY-62,3,6,1 
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510 


LINE RX+79,RY-58,RX+60,RY-63, 1 
PAINT RX+67,RY-70,2 
PAINT RX+80,RY-62,2 


REM *** KLAUW **% 

REC RX+84,RY-68,4,12,1 
PAINT RX+85,RY-67,2 
REC RX+88,RY-68,5,3, 1 
PAINT RX+89,RY-67,2 
BEC RAFBB, RET-S4,3, 4,1 
PAINT RX+89,RY-58,2 
RETURN 


REM *** WIS HOOFDMENU *** 
TEXT10, 24, "HOOFDMENU : EP 
LINE 10,34,81,34,0 

RESTORE: FOR I = 1 TÔ 9 

READ AH$ 

T=12+12*I 

TEXT100,T,AH$,0,1,8 
LINE100,T+8,108,T+8, 0 

NEXTI 

TEXT 100,132, "QUIT REET 
LINE 100,140,108,140,0 

RETURN 


REM *** HOOFDMENU *** 
TEXT10,24, "HOOFDMENU : Taeke 
LINE 10,34,81,34,3 


RESTORE: FOR I = 1 TO 9 

READ AH$ 

T=12+12*1I 

TEXT100,T,AH$,1,1,8 
LINE100,T+8,108,T+8, 3 

NEXT I 

TEXT 100,132, "QUIT PR DT: 
LINE 100,140,108,140,1 


RETURN 


REM xx BEVEL IN ONDERSTEL **%* 
VB=VB-1 


PX = RX+INT((50-LEN(BOS) *8) /2) 
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TEXT PX,RY+6,B0$,1,1,8 
RETURN ‘ 


REM *** WIS BEVEL IN ONDERSTEL *** 
PX = RX+INT((50-LEN(BO$) *8) /2) 

IF BOS<D>'""THEN TEXTPX,RY+6,B0%,2,1,8 
RETURN 


REM *** POSITIETABELLEN *** 
FOR I = 1 TO 6 

M5$ (1) =STR$ (MS (I)) :NEXTI 
FOR I=1TO6 

L = LEN(MS$(I)) 
IFL<STHENMS$ (I)=" "+MS$(I) :GOTO1013 
NEXTI 

TEXT 37,170,MS$(1) ,„1,1,8 
TEXT118,170,MS$(4) ,1,1,8 
TEXT 37,180,MS$(2),1,1,8 
TEXT118,180,MS$(5) ,1,1,8 
TEXT 37,190,MS$(3),1,1,8 
TEXT118,190,MS$(6),1,1,8 
PO=1:LOW COL 1,6,7 

RETURN 


REM *** WIS POSITIETABELLEN *** 
TEXT 37,170,VS$(1),0,1,8 
TEXT118,170,VS$(4),0,1,8 

TEXT 37,180,VS$(2),0,1,8 
TEXT118,180,VS5$(5),0,1,8 

TEXT 37,190,VS$(3),0,1,8 
TEXT118,190,VS$(6),0,1,8 
RETURN 


REM *** SUBMENU **« 

REM SM$=SMENU ; SN=AANTAL : D=DISTANCE 
25=1 

IF SU=0 THEN GOSUB600 

IF SU=1 THEN GOSUB1300 

TEXT 100,27,S5M$+":",1,1,8 
SB=1:B5=27+D 

IFSM$="LIMIT"THEN SB=0:BS=BS+D 
X5=110:IF SM$="MOVE"THEN X9=95 
FOR I =SBTOSN 

YS=BS5+D* (1-1) 
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TEXT XS ,„YS,STR$(I),1,1,8 

LINE XS+8,YS5+9,X5+15,Y5+9,3 
NEXT I 

Z5=0:SU=1 

RETURN 

REM *** WIS SUBMENU *** 

REM SM$=SMENU ; SN=AANTAL ;D=DISTANCE 
IF S2=1 THEN GOTO 1600 

TEXT 100,27,SM$+":",0,1,8 
SB=1:B5=27+D 

IFSM$="LIMIT"THEN SB=0:B5=B5+D 
X5=110 

FOR I =SBTOSN 

YS=BS+D* (1-1) 

TEXT XS ,„YS,STR$(I),0,1,8 

LINE XS5+8,YS+9,XS5+15,YS+9,0 
NEXT'I 


GU=0: IF ZS< >1THENGOSUB700 

52=0 

RETURN | 

REM*** ADDITIONELE MOVE-SUBMENU *** 


TEXT 
LINE 
TEXT 
TEXT 
TEXT 
TEXT 
TEXT 
TEXT 


45, 132, A5 „LateB 
95,141,110,141,3 
RX+52,RY-7,"1",1,1,8 
RX+53,RY-36,"2",1,1,8 
RX+61,RY-60,"3",1,1,8 
RX+77,RY-78,"4"',1,1,8 
RX+77,RY-54,"5",1,1,8 
RX+88,RY-54,"6",1,1,8 


TEXT 118,42,"+($2)OF($1)-",1,1,8 
FOR I= 1TO5 

TEXT 130,42+15*1I,"'",1,1,8:NEXTI 
TEXT 113,132, "+, te „1, 
S2=1 

RETURN 


REM *** WIS SUBMENU VOOR MOVE *** 
TEXT 95,134, "45 ,0,1,8 

LINE 95,141,110,141,0 

TEXT RX+52,RY-7,"1",0,1,8 

TEXT RX+53,RY-36,"2",0,1,8 








1630 
1640 
1650 
1660 
1680 
1690 
1695 
1700 
1701 
1710 
1720 
1730 
1740 
1750 
1760 
1770 
1780 
1790 
1799 
1800 
1810 
1811 
1820 
1825 
1830 
1840 
1850 
1900 
1903 
1905 
1910 
1911 
1915 
1916 
1920 
1930 
1940 
1950 
1960 
2000 
2005 
2010 
2015 
2016 


TEXT 
TEXT 
TEXT 
TEXT 
TEXT 
LINE 
LINE 


RATGL,.RY-DU, "4" ,0,1 
RX+77,RY-78, "4" 0,1 
RX+77,RY-54,"5",0,1 
RX+88,RY-54, "6", 0,1 
118,42, "+($2)OF($1) 
il8,5i,16,53,0 

144,51,150,51,0 


FOR I= 1TO5 


TEXT 
TEXT 
LINE 
TEXT 


FOR I 


130,42+15*I,"''",0,1,8:NEXTI 
A13, 132, "tbe", 0,1,6 
113,141,156,141,0 
100,27,"MOVE:",0,1,8 

=1TO6 


YS=42+15* (I-1) 
TEXT 95 ,YS,STR$(I),0,1,8 


LINE 


NEXTI 


GOTO 


103,YS+9,110,YS+9,0 


1355 


REM *** ONDERSTREPING MOVE *** 


FOR I 


LINE 
LINE 


- ITO 7 
95,36+15*I,110,36+15*I,0:NEXTI 
115, AL, 146,3, 


LINE142,51,150,51,3 


LINE 


113,141,156,141,3 


RETURN 


REM *** AANDUIDING MOTOR **«* 

LOW COL 1,13,8 
IFVM=/THENTEXT95,27+VM*15,"45"',1,1,8 
IF VM<1 OR VM>6 THEN 1915 
TEXT95,27+VM*15,STR$(VM),1,1,8 

IF G<27 THEN 1920 
TEXT95,27+G*15,"45'"',2,1,8:GOT01930 
TEXT95,27+G *15,STR$(G ),2,1,8 


VM=G 


LOW COL 1,6,7 
RETURN 


REM *** MAXIMUM BEGRENZING *** 
LOW COL 1,4,7 

MS5$ (G) =STR$ (MS (G) ) 

L = LEN(MS$(G)) 


IFL<STHENMS$ (G) ="' 


“+M5$ (G) :GOTO2015 
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2020 
2021 
2030 
2040 
2050 
2051 
2060 
2070 
2080 
2110 
2111 
2120 
2123 
2125 
2130 

190 

200 
2203 
2205 
2208 
2210 
2215 
2220 
2221 
2225 
2230 
2240 
2250 
2255 
2260 
2265 
1270 
2275 
2277 
2280 
2290 
2295 
4790 
4800 
4805 
4810 
4815 
4820 
4970 
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IF G<4 THEN 2030 
XL=83:XT=118:YL=130+G*10:GOTO 2050 
XT=37:YL=160+G* 10: XL=9 

IF G=1 THEN XL=1 

L=XL+ (LEN(STR$ (MM(G) ) ) -1) *8 
LINEXL,YL+8,L, YL+8, 2 

TEXT XT,YL,VS$(G),0,1,8 

TEXT XT,YL,MS$(G) ,2,1,8 

GET R$ : IF R$=""THEN2080 

L = XL+(LEN(STR$ (MM(G)))-1) *8 
LINEXL, YL+8,L, YL+8,0 

TEXT XT,YL,MS$(G),0,1,8 
IFFL=2ANDG=5THENG=4: YL=170:GOTO2110 
LOW COL 1,6,7 

RETURN 


REM *** HERE'S EN GO'S *** 


IF A$= "G" THEN 2255 
LOW COL 1,10,7 

IF A$= "G!" THEN 2260 
FOR I = 1 TO 9 

FOR J = 1 TO 6 

IF RH(I,J) = OTHEN 2225 


TEXT110,27+12*I,STR$(I) ,2,1,8 
NEXTJ 


NEXT I 

LOW COL 1,6,7 

RETURN 

LOW COL 1,10, 7 

FOR I = 1 TO 9 

FOR J = 1 TO 6 

IF RH(I,J)<>OTHEN 2280 
NEXT J 


TEXT 110,27+12*I,STR$(I),2,1.8 
NEXT 
LOW COL 1,6,7 


RETURN 

REM *** HOOFDMENU DATA *** 
DATA" ZERO "NEST à 
DATA"LIMIT "SPEED ie 
DATA'"'MOVE !, “HERE ä 
DATA"GO !, POPEN ij 


DATA"CLOSE ä 








REM*** START REALTIME PROGRAMMA **% 


IF OP <2ITHEN OPEN 4,4, 7 

OP=1 

PRINT#4, "Z" 

PRINT#4, "M500,0,0,0,0,0" 
PRINT#4, "N" 

FL=0 

FOR I=1TO 6:VS5$(I)="":NEXTI 
GOTO51 70 

GOSUB 950: IF SU=1 THEN GOSUB1300 
REM SM —> HM;BO WEG = VERKEERD COM 


REM ***INLEZEN BEVEL *** 

GET A$:IF A$=""THEN 5170 
IFAS< 5" +"AND A$<D'"—"THEN 5190 
IFFL=1 THEN T$=A$:A$f="M":GOTO5480 


IFA$ ="+" ORA$ ="—"THEN 5194 
IFA$ ="++" ORA$ ="|I "THEN 5194 
GOTO 5195 


IF FL=2 THEN T$=A$:A$="M":GOTO5570 
IFFL =0 ORA$< "1" ORA$>"6"THENS200 
G$=A$:A$="M": GOTO5A50O 

FL=0 


REM *** 1 TOETSBEVELEN *** 
REM 

IF A$<>"Z"ANDAS<D>"N" THEN5220 
FOR I=1T06:MS(I)=0:NEXTI :B$=A$ 
BO$="ZERO":IF A$="N" THEN BO$="NEST": 
KB=1 

GOTO 5670 

REM 

IF A$<>"C"THEN 5230 
MS (6) =0:B$=A$ 

KB=1 : BO$="CLOSE" 
GOTO 5670 

REM 

IF A$<>"O"THEN 5250 
MS (6) =-1800:B$=A$ 
KB=1 : BO$="OPEN" 
GOTO 5670 


Z4-N 


HC 


HO 
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5240 
5249 
5250 
9255 
5260 
5270 
5275 
5280 
5289 
5290 
A95 
5300 
5310 
5320 
5330 
5335 
5340 
5349 
5350 
5352 
JS 
5358 
5360 
5370 
5380 
5385 
5390 
5391 
5395 
5400 
5405 
5409 
5410 
5420 
5425 
5428 
5430 
5440 
5445 
5450 
5455 
5460 
5465 
5470 
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REM *** 2 TOETSBEVELEN *** 


REM L 
IF A$<>"L" THENS5290 
SM$="LIMIT":SN=1:D=30 : GOSUB1200 

GET G$: IF G$="" THEN 5260 

IF G$ <"O"OR G$2"1"THEN 5160 
BO$="LIMIT" 

GOTO 5670 

REM #5 
IF A$<>"S"THEN 5350 
SM$="SPEED":SN=5 :D=20 : GOSUB1200 

GET G$: IF G$="" THEN 5300 

IF G$ <"1"OR G$"S "THEN 5160 
V$=STR$ (VAL (G$) 1 3) 

B$=A$+G5 

BO$=" SPEED " 

GOTOS56 70 

REM #H-G 
IF A$ <> “HAND A$<) "G"THEN 5420 
SM$="HERE":IF A$="G"THEN SM$="GO" 


SN=9:D=12:GOSUB 1200 

GOSUB 2200 

GET G$:IF G$="" THEN 5360 

IF G$<"1"OR G$)"9" THEN 5160 

IF A$<2"H" THEN 5390 
FORI=1ITO6:RH(VAL(GS) , I) =MS(I) :NEXTI 
IF A$D<"G" THEN5395 


FORI=1TO6 :MS (1) =RH(VAL(G$) „I) :NEXTI 
BO$=SM$ 

B$=A$+G$: GOTO 5670 

REM 4M 


REM X%*%X MOVE *** 
IF A$<> "M" THEN 5660 


SM$='"'MOVE'":SN=6 :D=15 : GOSUB1200 
GOSUB1400 
GET G$ IF G$="" THEN 5430 


IF G$< "1 "OR 6$>"6 "THEN 5160 
GOSUB1800 

G=VAL(G$) :GOSUB1900 

GET T$: IF T$ = "" THEN 5455 
IF T$="5" AND G$="4"THENSS50 
IFT$>"O"ANDT$< "7 "THENG$=T$ : GOTO5 450 
IF T$<>"+"AND T$<D'"'—!" THEN 5160 











5480 
5490 
5500 
5910 
5513 
5514 
5515 
5516 
5317 
5920 
522 
5530 
5540 
5542 
5545 
55590 
IL 
5952 
ska 
5558 
5260 
5562 
5570 
5580 
5990 
5600 
5610 
5620 
5630 
5640 
5642 
5645 
5646 
5647 
5648 
5649 
5650 
5651 
>652 
5653 
5654 
5655 
„660 
5662 


FOR I = 1 TO 6 X$(I)="O":NEXT I 
IFV$=""THEN V$="1" 

G=VAL (G$) : X$(G) =T$+V$ 

M5 (G) =MS (G) +VAL (X$ (G) ) 

IF ABS(MS(G)) >MM(G) THEN GOSUB 2000 
IF R$=CHR$(13)OR R$=""THEN 5520 

DE =VAL(V$) -ABS(MS(G) ) +MM(G) 

X$ (G) =STR$ (SGN (VAL (X$ (G) ) ) *DE) 

MS (G) =SGN (MS (G) ) *MM(G) :R$="""' 
B$=AS+XE(I) +", "+XE(2) +", "KEI +", " 
B$=B$+X$(4) +", "+KE(5) +", + X$(6) 
FL=1 

GOTO56 70 


REM *** MOVE 4 EN 5 **x* 

G=7 :GOSUB1900 

M5 (4) =SGN (M5 (4) ) *MM(4) :R$="""' 

MS (5) =SGN(M5 (5) ) *MM(5) :R$="""' 

GET T$:IF T$="" THEN 5555 

IFT$ 2" O"ANDTS$< "7" THENGS$=T$ : GOTO5 450 
IF T$ ="+" ORT$ ="—"THEN 5570 

IF T$<2"+"ANDTS$<Ò"I "THEN 5160 

IF V$=""THEN V$="1" 


X$ (4) =V$:X$ (5) =V$ 
IFT$="—"THENXS$ (4) =T$+V$: X$ (5) =T$+V$ 
IFT$="+"THEN X$ (59) ="—!"+V$ 
IFT$=" | "THEN X$(4)="—!"+V$ 


B$="MO,0,0, "+X$ (4) +", "+X5(5) +"',0"' 
MS (4) =M5 (4) +VAL(X$ (4) ) 

M5 (5) =M5 (5) +VAL(X$ (5) ) 

FL=2: 

IFABS (MS (4) ) >MM (4) THENG=4 : GOSUB2000 
IFABS (MS (5) ) 2MM(5) THENG=5 : GOSUB2000 
IF R$=CHR$(13)OR R$=""THEN 5655 

DE = VAL(V$)--ABS(MS (4) ) +MM(4) 

X$ (4) =STR$ (SGN (VAL (X$ (4) ) ) *DE) 

DE = VAL(VS$)--ABS (MS (5) ) +MM(5) 

X$ (5) =STRS$ (SGN(VAL(X$ (5) ) ) *DE) 

M5 (4) =SGN (MS (4) ) *MM(4) :R$="" 

M5 (5) =SGN (MS (5) ) *MM(5) 
B$="MO,0,0, "+X$ (4) +", "+X$ (5) +",0" 
GOTO56 70 

IF A$<>"Q"THENS5S160 

PRINT4#4, "N":CLOSE 4: END 
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5708 
5710 
5720 
5730 
5740 
5750 
3731 
3/52 
5753 
5760 
5770 
5780 


REM kx EINDE HOOFDPROGRAMMA *** 
REM *** ROBOTSTURING *** 11: 

IF LEFT$(B$,1)="M"THEN BO$='"MOVE" 
GOSUB900 : REM 

REM PLAATS BEVEL IN ONDERSTEL 
IFPO=1THENGOSUB1100:REMWIS POSITIE 
PRINT4#4,B$ 

GOSUB950:REM WIS ROBOTBEVEL 
GOSUB1000:REM PLAATS POSITIE 

FOR I=1T06:VS$(I)=MS$(I) :NEXTI: 

IF SU=1 ANDA$<>'M'" THEN GOSUB1300 
POKE 198,0 

IF FL=OTHEN5S170 

POKE650, 128 

WAIT 198,1:GET T$ 


POKE 198,0:POKE 650,0 

IF T$= "+" ORT$ ="—"THENS5753 
IF T$= "+" ORT$ =" | "THENS753 
GOTO 5760 


IF FL=2THEN5580 

IF T$="+"ORT$="-—"THEN 5500 
A$=T$ 

GOTO5 180 


READY. 
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WOORDENLIJST ROBOTICA 


Absolute encoder: een type van positiesensor waarvan de output de absolute 
positie van een gewricht specificeert. Zie ook incrementele encoder. 


Actuator: toestel dat elektrische, pneumatische of elektrische energie omzet 
in een translatie- of rotatiebeweging. De meeste voorkomende actuators zijn 
hydraulische motoren, stappenmotoren en servo’s. 


Adaptieve regeling: regelmogelijkheid van een robot of van een machine om 
zijn uitgang te veranderen door de aanpassing van de regelparameters vol- 
gens de ontvangen sensorinformatie van de omgevingsomstandigheden. 


Algoritme: een verzameling van welbepaalde rekenregels voor de oplossing 
van een probleem in een eindig aantal rekenstappen. Voordat er een pro- 
gramma kan worden geschreven moet er een geschikt algoritme worden ge- 
vonden. Vaak zijn er voor de oplossing van hetzelfde probleem verschillende 
algoritmen mogelijk. Het ene vereist meer computertijd, het andere kan snel- 
ler de oplossing vinden, maar neemt dan weer meer geheugenruimte in 
beslag. 


Alfanumeriek: alle lettertekens, cijfertekens en speciale tekens in een compu- 
tertaal. 


Analoog: waarden die binnen een bepaald bereik zodanig kunnen verande- 
ren zodat ieder punt van dat bereik een mogelijke waarde is. Rotatie, transla- 
tie, elektrische weerstand et cetera, zijn voorbeelden van analoge groothe- 
den. Een analoge sensor levert een elektrische spanning (of stroom) af die 
evenredig is met de te meten grootheid. Zie ook digitaal. 


Analoog-naar-digitaal omzetting (ADC: analog to digital conversion): om- 
zetting van analoge informatie in digitale vorm. De belangrijkste toepassing 
van ADC in de robotica is de verbinding van de analoge sensor aan de bestu- 
ringscomputer. 


Androïde: een robot die uiterlijk op een menselijk wezen lijkt. Gewoonlijk 
vindt men androïdes in de zogenaamde pseudo robotten, die voor reclame 
doeleinden of voor science fiction-films worden gebruikt. 


Antropomorfologisch: alle voorwerpen die wat de uiterlijke vorm of de in 
nerlijke karakteristieken betreft, op de mens lijken. 


Arm: algemene term voor het verbindingsstuk aan te duiden dat zich tussen 
twee opeenvolgende gewrichten bevindt. Robotarmen worden ook soms ma 
nipulators genoemd. 
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Artificiële Intelligentie (Artificial Intelligence): geschiktheid van machine of 
van een computer om bepaalde menselijke, zogenaamde intelligente functies 
uit te voeren, zoals: leren, associëren, redeneren en zelf-sturen. A I is één 
stap verder dan adaptieve sturing. 


Automatie: automatische werking en besturing van toestellen; processen of 
systemen. Het is de algemene term voor werking en besturing onafhankelijk 
van een rechtstreekse menselijke ingreep. 


Backlash: spel in de mechanische transmissie zodat er een kleine vertraging 
ontstaat tussen het moment waarop de aandrijving start en het moment 
waarop het aangedreven element beweegt. Backlash geeft aanleiding tot een 
vorm van hysteresis en niet-lineariteit. 


Bang-bang control: besturingsmethode waarbij een besturingsorgaan een be- 
paald mechanisch onderdeel in beweging brengt tot dit bewegend element 
een mechanische stop raakt. Wordt gebruikt voor point to point-sturing van 
robotten. 


BASIC: Beginner’s All-purpose Symbolic Instruction: eenvoudige compu- 
tertaal beschikbaar op de meeste microcomputers onder de vorm van ver- 
_ schillende dialecten die niet steeds met elkaar compatibel zijn. Computertaal 
die gebruikt wordt voor de sturing van eenvoudige robotten. 


Batch manufacturing: productie van machine-onderdelen of van materialen 
in aparte discrete produktieprocessen (zogenaamde batches). Tegengestelde 
van continuê produktie. 


Besturingssysteem: Control system: het toestel te zamen met de procedures 
die gebruikt worden om een bepaalde operatie uit te voeren met het oog op 
het bereiken van een bepaald resultaat. Sensoren, logic units, computers en 
actuators vormen de componenten van zo’n systeem. 


Bolcoördinaten: een coördinatensysteem gespecificeerd door twee hoeken en 
de afstand tot een oorsprong. Deze coördinaten noemt men meestal azi- 
muth, elevatie en bereik. 


CAD/CAM: Computer Aided Design Computer Aided Manufacturing: het 
gebruik van computers voor het ontwikkelen of het produceren van goede- 
ren in een fabriek of in een geautomatiseerd systeem. 


Cartesiaanse coördinaten: een coördinatensysteem met drie onderling 
loodrechte assen. Een cartesiaanse robot kan in drie onderling loodrechte 
richtingen (X, Y en Z) bewegen. 


CCD-array: Charge Coupled Device array: een vorm van een geïntegreerd 
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circuit dat gevoelig is voor licht en dat als alternatief van een televisiecamer a 
gebruikt wordt in robotvisie. Een beeld dat op de oppervlakte van zo'n 
CCD-chip wordt geprojecteerd door middel van een lenzensysteem geelt 
aanleiding tot een patroon nullen en enen, dat door de computer kan worden 
afgelezen op dezelfde wijze als het uitlezen van een computergeheugen. 


Cilindrisch coördinatensysteem: een coördinatensysteem dat beschikt over 
twee lineaire bewegingen (verticaal en horizontaal) en een circulaire bewe- 
ging rond een verticale as. Een robotsysteem in cilindrische coördinaten 
heeft een arm die langer of korter kan worden gemaakt, die verticaal be- 
weegt en die rond de verticale as draait. 


Compliantie: de eigenschap te bewegen of te buigen zonder te breken door 
de toepassing van een uitwendige kracht. In de robotica laat het de robot toc 
de grijper of het gereedschap in lijn te brengen met een ander voorwerp. 


Computer Numerical Control: CNC: gebruik van een computer om een nu- 
merieke besturing van een werktuigmachine of van een robot te realiseren. 


Computed path control: een besturingsmethode waarbij de gewenste baan 
van het centrum van het polsgewricht de bewegingen van de gewrichten en 
armen door middel van een computer regelt. 


Contact sensor: toestel dat in staat is van een mechanisch contact te detectc- 
ren en een elektrisch signaal als resultaat te produceren. 


Continuous path control: een besturingsmethode die de doorlopen baan op 
een groot aantal punten in de ruimte vastlegt, waardoor deze baan binnen de 
grenzen van de gewenste nauwkeurigheid als continu te beschouwen is. 


Cybernetica: de studie van de besturingssystemen bij dieren en bij mensen. 
Gegrondvest door Norbert Wiener, gaf de cybernetica een formele wiskundi- 
ge basis voor de principes van de tegenkoppeling. 


Debug: het opzoeken en corrigeren van fouten in de hardware en in de solt 
ware van computersystemen. 


Default: (systeembepaald): een waarde, conditie of een toestand, die aange 
nomen wordt als geldig als er geen andere informatie aan het systeem wordt 
toegevoerd. Defaultkarakteristieken zijn eigenschappen die door het systeem 
zelf bepaald worden en slechts door het programma of door ingrepen in de 
hardware kunnen worden gewijzigd. 
Digitaal: waarden die tussen een maximum en een minimum grens met een 
geheel aantal elementaire toenamen of kwantgrootheden veranderen. Nume 
rieke informatie. 
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Digitaal-naar-analoog: omzetting van digitale informatie naar analoge vorm 
met het doel analoge toestellen te sturen. 


Dode zone: een beweging of een signaalbereik waarbinnen een input- 
verandering geen wijziging van de uitgang van een sensor of van een mecha- 
nisch toestel teweegbrengt. 


EEPROM: Electrically Erasable Programmable Read Only Memory: leesge- 
heugen dat dezelfde werking heeft als een EPROM maar dat elektrisch kan 
worden ingeschreven en uitgewist in een korte tijd. 


Electro-optical isolator: (Opto-coupler): een elektronische component die 
een elektrisch signaal omzet in een lichtsignaal en dit lichtsignaal opnieuw in 
een elektrisch signaal omzet met het doel twee circuits elektrisch van elkaar 
te scheiden. Wordt gebruikt als beschermingsmiddel tegen spanningsver- 
schillen. | 


Elevatie: afstand boven een horizontaal vlak of hoek tussen een horizontaal 
vlak en een rechte lijn in een verticaal vlak. 


Emulator: een programma of hardwareschakeling die een ander programma 
of een andere hardwareschakeling imiteert. Gewoonlijk wordt een emulator 
tijdelijk gebruikt als het werkelijke programma of de werkelijke schakeling 
voorlopig niet beschikbaar is. 


Encoder: toestel dat gebruikt wordt om een lineaire meting of een hoekme- 
ting in een digitale code om te zetten. 


End effector: grijper of ieder ander werktuig dat bevestigd is aan het uiteinde 
van een robotarm om nuttig werk te verrichten. Het kan een universele grij- 
per zijn met twee of drie vingers of een speciaal gereedschap om te slijpen, te 
lassen, te polieren, te schilderen et cetera. Bepaalde robotten beschikken 
over de mogelijkheid hun end effector te verwisselen onder computerbestu- 
ring. 


EPROM: Erasable Programmable Read Only Memory: een leesgeheugen 
dat traag kan worden ingeschreven en heel snel kan worden uitgelezen en dat 
door middel van een bestraling met ultra violet licht kan worden gewist. Het 
wordt onder andere gebruikt als tijdelijke ROM tijdens de ontwikkeling van 
een toestel. | 


Exoskeleton: een mechanische structuur die aan het menselijk lichaam aan- 
gepast is met het doel de kracht van een menselijke operator te vergroten. De 
toegepaste technologie is sterk verwant met de technologie van de industriële 
robotten. De exoskeleton wordt zowel toegepast in de behandeling van mate- 
rialen als in de ondersteuning van de gehandicapte mens. 
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Feedback (terugkoppeling): techniek die er in bestaat een signaal vanuit cen 
punt van het proces af te takken en naar de ingang terug te voeren, met oog 
op de verbetering van de dynamische en statische eigenschappen van het 
systeem. Feedback vormt een essentiële functie in servo-bestuurde robotten 
en in andere besturingssystemen. 


FMS: Flexible Manufactoring System: het tegengestelde van ’’dedicatcd 
automation’’ (specifiek taakgerichte automatisering), waarbij ieder onder- 
deel van een produktielijn speciaal ontwikkeld werd voor dat te vervaardigen 
produkt. FMS maakt gebruik van robotten en computerbestuurde machine- 
gereedschap, gewoonlijk georganiseerd in werkcellen, die opnieuw kunnen 
worden geprogrammeerd om een volledig nieuw produkt te vervaardigen. 


Gewricht (joint): in een robotarm een mechanisch onderdeel dat de beweging 
van de arm in een translatie of in een rotatie teweegbrengt. 


Hydraulische motor: een actuator die bekrachtigd wordt door een 
oliestroom of door een andere vloeistof om een lineaire of een draaiende me- 
chanische beweging tot stand te brengen. 


Hysteresis: een eigenschap van een mechanisch of elektrisch toestel, waarbij 
er een verschil optreedt in zijn karakteristieken in de voorwaartse en in de 
omgekeerde richting tengevolge van wrijving, opgehoopte energie of andere 
factoren. Hysteresis is een bron van fouten in diverse praktische systemen. 


Industriële robot: een herprogrammeerbare multifunctionele manipulator 
ontworpen voor het bewegen van materiaal, mechanische onderdelen, ge- 
reedschappen of gespecialiseerde toestellen door variabel geprogrammeerde 
bewegingen en voor de uitvoering van een veelvuldigheid van taken. 


Inertie: de neiging van een massa in rust om in rust te blijven of van een mas 
sa in beweging om in beweging te blijven. Er is een kracht vereist om de be 
weging en de snelheid van een massa te wijzigen. 


Integrerende actie: een type van servo-sturing waarbij het ingangssignaal 
wordt veranderd door de integraal van het foutsignaal in de tijd. 


Intelligente robot: een robot die objecten in zijn omgeving kan waarnemen 
Hij bevat opgeslagen informatie (de zogenaamde knowlegde base) en cen set 
van produktieregels en programma’s zodanig dat hij in staat is bepaalde tu 
ken volledig zelfstandig uit te voeren. De intelligente robot is van een niveau 
hoger dan de adaptieve robot. 


Interface: een grensgebied dat door twee toestellen of door twee 

programma’s met elkaar wordt gedeeld of de wisselwerking tussen mens en 

machine waarbij een bepaald soort van operatie of communicatie wordt ver 
A 


richt. 


Joy stick: een beweegbare pook verbonden met de besturingsschakelingen 
zodanig dat de beweging ervan signalen voortbrengt voor de besturing van 
robotten of van andere toestellen. 


Lead through: in robotsturing een middel voor het programmeren van een 
robot om deze een bepaalde taak te laten uitvoeren door deze met de hand 
een reeks van operaties te laten uitvoeren en de coördinaten van de punten 
van de doorlopen weg te laten optekenen. 


Limit switch: een elektrische schakelaar die omklapt onder invloed van een 
mechanische beweging wanneer een bepaald onderdeel van een toestel een 
vooraf bepaald punt bereikt. 


Manipulator: een mechanisme samengesteld uit verbindingsstukken en ge- 
wrichten dat in staat is voorwerpen vast te grijpen en over kleine afstanden te 
verplaatsen onder besturing met de hand. 


Off-line: toestellen die niet rechtstreeks met een computer of met een com- 
municatielijn verbonden zijn. | 


On-line: toestellen die rechtstreeks met een computer of met een communica- 
tielijn verbonden zijn. 


Open-lus: een besturingsmethode waarbij de opdrachten aan een toestel of 
aan een robot worden gegeven maar waarbij er geen middelen zijn voorzien 
om na te gaan of deze opdrachten werden uitgevoerd. Er wordt hier geen 
feedback geleverd. 


Pattern recognition: de meest geavanceerde trap in robotvisie. Het waarge- 
nomen beeld wordt vergeleken met een lijst van bekende voorwerpen die in 
het computergeheugen opgeslagen zitten. De beelden zullen praktisch nooit 
identiek zijn, waardoor de computer de beste overeenkomst zoekt. Een veel 
gebruikte techniek bestaat in de vergelijking van een aantal parameters zoals 
de oppervlakte van de doorsnede, de totale omtrek et cetera. 


Pick-and-place-robot: een eenvoudige robot bedoeld om voorwerpen van de 
ene plaats naar de andere plaats over te brengen zonder dat dat traject dat 
hierbij wordt doorlopen kan worden bestuurd. Pick-and-place robotten heb- 
ben gewoonlijk slechts twee of drie vrijheidsgraden. 


Pitch: draaihoek van de robothand rond een horizontale as. Komt overeen 
met de wuif-beweging van de menselijke hand. 
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Point-to-point-control: robotsturing waarbij de input-commando’s alleen 
enkele punten langs de te doorlopen weg specificeren en waarbij dus de ro- 
bothand tussen twee gespecificeerde punten deze weg kan verlaten. Point-to- 
point control is een goedkope en minder nauwkeurige besturingsmethode. 
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“Werken met robots’ door P.E.M. van 
den Wyngaert, C.J.W. Vanhoeylandt 
en G.M.I. van Landeghem; 96 pagi- 


na’s met zwart-wit illustraties; prijs 
f 24,50; Maklu Uitgevers Antwerpen- 
Apeldoorn; ISBN 90 6215 166 3. 


Bij Maklu uitgevers is onlangs een 
boek verschenen met de veelbeloven- 
de titel Werken met robots’. Wie het 
boek inziet, zal concluderen dat de 
titel eigenlijk had moeten zijn: ’Wer- 
ken met de CS-113’. | 

De CS-113 is een vrij bekende tafelro- 
bot, die vooral is ontwikkeld voor 
onderwijsdoeleinden. Het is een een- 
voudige robotarm met gelede geome- 
trie en vijf vrijheidsgraden; een bouw- 
vorm die men zeer veel bij operatio- 
nele industriële robots tegenkomt. De 


enkele (Simons)Basic-programma’ S 
voor de besturing van de CS-113. Een 
greep daaruit: joystick besturing, 
tweedimensionale robotarmsimula- 
tie, robotsturing vanuit Cartesiaanse 
stelsel en een eenvoudige realtime be- 
sturing (als eerste kennismaking met 
de teach-in programmeerwijze). Ook 


worden veel pagina’s gewijd aan een 


technische beschrijving van de robot. 
Het boek completeert zichzelf met 
twee hoofdstukken beschrijving in 
vogelvlucht van het verschijnsel in- 
dustriële robot, waarin aandacht voor 
de geometrische verschijningsvor- 
men, besturingsprincipes en types 


verhieldn C64 ‘leent. zich er. prima 
voor. Het boek beschrijft met name 





ter. — 


Het alnoizene deel van het boek heeft 


niet zo veel diepgang. Voor gevorder- 


de technici die meer willen weten van 
de industriële robot, kan het boek …— 
niets betekenen. Maar voor 
onderwijsprojecten (bijvoorbeeld in 
het MTO) waarbij de CS-113 (die 
door Sciento uit Den Bosch wordt 
aangeboden) wordt gebruikt, kan het 
boek voldoende stof aandragen om er_ 
een aantal interessante practica op te 
baseren. De programmalistings zijn 
zorgvuldig gedocumenteerd, zodat 
met beperkte wijzigingen ook andere 
hardware gebruikt zou kunnen wor- 
den. | ë 
HERBERT BOLAND 














